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ABSTRACT 


Aclapdli  Sricllm-  M.S.,  Departme^^^  of  Electrical  Engineering,  Wright  State  Univer¬ 
sity,  1989.  Design  of  a  Decoupling  Controller  for  the  Utah/M.I.T.  Dexterous  Robot 
liana. 

This  thesis  describes  the  design  of  a  decoupling  controller  for  the  Utah/Af.I.T, 
Dexterous  Hand  (DH).  The  DH  is  of  a  semi-anthropomorphic  configuration  and  pos¬ 
sesses  three  fingers  and  a  thumb,  each  consisting  of  four  joints.  An  analog  controller 

of  the  proportional  plus  derivative  type,  is  used  to  control  the  movements  of  different 
joints  of  the  DH. 

file  diflerent  gam  blocks  of  the  analog  controller  and  the  position  and  tendon 
tension  sensors  of  each  joint  are  calibrated.  The  dynamics  of  each  joint  is  determined, 
and  the  control  parameters  for  the  PD  controller  of  each  joint  are  calculated.  The 
three  distal  joints  of  the  DH  are  mechanically  coupled,  i.e.  the  movement  of  one 
joint  results  in  the  movement  of  the  other  coupled  joints.  An  algorithm  to  decou¬ 
ple  different  joints  of  the  DH  is  proposed  .  The  simulation  results  obtained  using 
SYSTEM.BUILD  utility  of  MATRIX,  show  that  joints  of  tlie  DH  can  be  controlled 
independently  when  the  decoupling  algorithm  is  included  with  the  PD  controller. 

Software,  to  implement  the  decoupling  algorithm,  is  written, in  the  ‘C’  programming 
language. 
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I  .  INTRODUCTION 


1.1  AN  OVERVIEW 

The  Air  Ibrce  has  a  great  need  to  maintain  force  survivability  and  base  operability 
during  wartime  scenarios  in  chemical,  biological  and  radiological  environments.  The 
Robotic  Tel('|)reseuce  (R/T)  program  at  the  Hariy  G.  Armstrong  Aerospace  Medical 
Research  Laboratory  (AAMRL)  is  based  on  the  jieed  to  project  human  intelligence, 
perceptual  capabilities  and  motor  skills  into  hostile  environments  through  the  use  of 
human  controlled  robots,  thereby  removing  the  human  operator  from  hazardous  en¬ 
vironments.  One  of  the  objectives  of  the  R/T  program  is  to  investigate  the  feasibility 
of  utilizing  remote  huma.n-in-the-loop  control  of  dexterous  robots  to  perform  oper¬ 
ational  tasks  such  as  aircraft  inspection  and  servicing,  explosive  ordinance  disposal, 
and  environmental  monitoring  and  decontamination  [1]. 

In  the  R/'L  concept,  human-in-the-loop  control  of  the  remote  robot  is  achieved 

by  feeding  r()I)ot/task  state  information  back  to  the  operator  via  intuitive  and  natural 

displays.  This  allows  the  operator  to  effectively  ‘see,  feel  and  manipulate’  ol)jccts  at 

the  work-site  and  then  issue  appropriate  position /force  commands  to  the  slave.  The 

control  system  will  link  human  judgement,  adaptability  and  dexterity  in  real  time 

to  a  robot  system  capable  of  operating  in  lethal  environments.  In  some  cases,  the 

human-controlled  robot  performance  can  be  scaled  up  or  down  to  substantially 

;  1 


ex- 


ceecl  human  capabilities,  such  as  lifting  heavy  objects  or  performing  micro  movements 
with  precision  end  effectors. 

The  go;il  of  the  R/T  program  is  to  develop  a  series  of  dynamic  telepresence 
test  cells  integrating  state-of-the-art  components  such  as  visual  displays,  sensors,  and 
robotic  manipulators.  These  test  cell  stations  will  provide  experimental  tools  for 
research  into  human  factor  issues  associated  with  the  human-in-the-loop  control  of 
tele-robotic  systems.  Issues  to  be  investigated  include  master/slave  control  of  dex¬ 
terous  robotic  arms  and  hands,  force  reflection  techniques,  time  delay  compensation, 
visual  and  tactile  feedback  requirements,  etc.  Development  and  implementation  of 
appropriate  control  algorithms  are  required  to  allow  human-in-the-loop  control  of 
the  remote  system.  The  remote  system  pertaining  to  this  report  is  the  Utah/M.I.T. 
dexterous  rol)ot  left  and  right  hands  attached  to  appropriate  robot  arms. 

1.2  SCOPE  OF  THE  R/T  PROGRAM 

One  ol  (lie  objectives  of  the  R/T  program  is  to  develop  and  implement  dex¬ 
terous  hand  control  algorithms  to  effectively  slave  the  Utah/M.I.T.  Dextrous  Hand 
(DH)  to  an  cxoskeleton  master  worn  by  the  human  operator.  A  right  and  left  pair 
of  Utah/M.I.T.  Dexterous  Hands  has  been  installed  at  AAMRL  at  Wright  Patterson 
Air  Force  Base. 

figure  1 .1  depicts  the  master/slave  dexterous  hand  system  architecture  [1].  The 
position  sensors  in  the  exoskeleton  master  send  position  information  to  the  master 
processor.  '^Phe  master  processor  converts  these  positions  to  normalized  human  joint 


positions.  'I'lic  host  computer  maps  the  normahVxxl  human  joint  positions  to  the  de¬ 
sired  joint  positions  of  the  slave,  and  issues  appropriate  position/force  commands  to 
the  slave.  1  he  joints  on  each  digit  of  the  dexterous  hand  are  mechanically  coupled, 
i.e.  wlien  one  joint  is  commanded  to  move,  the  other  joints  also  move.  To  o\prcome 
this,  the  host  computer,  with  the  help  of  decoupling  algorithms,  decouj)lcs  the  dif- 
lerent  joints  ol  the  hand.  The  host  computer  then  issues  appropriate  position/force 
commands  lo  the  analog  servo  controller  of  the  DU.  The  analog  controller  applies  a 
current  that  is  proportional  to  the  input  voltage  to  the  pneumatic  actuators.  These 
in  turn,  drive  the  joints  which  are  connected  to  the  actuators  through  tendons.  The 
joint  position  and  tendon  tension  data  are  fed  back  to  the  analog  controller.  A  part 
of  the  above  mentioned  work  is  being  performed  at  Wright  State  University  (shown 
enclosed  in  dotted  lines  in  figure  1.1).  This  report  deals  with  the  development  of  the 
the  decoupling  hand  control  algorithms  and  the  design  of  the  individual  loop  joint 
design  parameters  required  to  slave  the  Utah/M. I.T.  DH  to  the  exoskeleton  master. 


Figure  1.1  Master/slave  dexterous  hand 
system  architecture  [ij 


1.3  THESIS  OBJECTIVE 


•) 


The  objective  of  this  project  is  to 

•  experimentally  measure  and  perform  computer  simulations  of  the  operating 

characteristics  of  the  different  joints  of  the  Utah/M. I.T.  DII. 

•  identify  l.lie  transfer  function  of  each  joint  of  finger  1  of  the  Utah/M.J.T.  DH. 

•  experimentally  determine  the  design  parameters  for  tlie  position  control  loop  of 
each  individual  joint. 

•  develo|)  a  scheme  to  decouple  different  joints  of  a  finger. 

•  ]xn-(orm  computer  simulations  of  the  decoupling  algorithms  in  MATRIX^ 


•  develop  a,  C  code  for  the  decoupling  algoritlims. 


11.  BACKGROUND 

This  dwi.ptcr  discusses  the  need  for  dexterous  end  effectors  and  describes  the 
Utah/M. I.T.  dexterous  hand. 

2.1  NEED  FOR  DEXTEROUS  END  EFFECTORS 

R.escarch  in  dexterous  liands  for  inanipulatoi's  is  a  relatively  new  area  of  robotics, 
which  is  now  developing  rapidly.  Tliis  is  because  of  the  increasing  realization  among 
researchers  that  dexterous  end  effectors  have  a  wide  range  of  applications  in  indust  ry. 
J.  he  lack  of  caj)a.bilities  of  current  end  effectors  is  increasingly  being  felt  as  one  of  the 
main  reasons  lor  the  limited  usage  of  robots  in  current  industrial  applications.  The 
studj^  ol  dexterous  end  effectors  is  an  exciting  field  with  many  unsolved  problems  in 
both  mechanical  design  and  control  [2]. 

Dexterous  end  effectors  with  sensing  abilities  need  to  be  developed  for  the  fol¬ 
lowing  reasons  : 

1.  Current  end  effectors  limit  the  flexibility  and  capability  of  manipulator  systems 

due  to  lack  of  abilit}^  to  handle  arbitrary  parts.  The  most  common  end  effector 

currently  being  used  in  industry  is  the  parallel  ja.w  gripper.  The  parallel  jaw 

gripper,  while  capable  of  performing  a  number  of  tasks,  nevertheless  limits  the 

kind  of  objects  which  may  be  grasped  and  the  ways  in  which  they  may  be 
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manipulated.  The  use  of  parallel  jaw  grippers  in  industry  can  be  compared  to 
a  car  inechanic  using  only  pliers  to  execute  all  repairs  [3]. 

2.  Ciirient  end  effectors  also  lack  sensing  abilities.  The  vast  majority  of  current 
robotic,  applications  in  industry  involve  applications  such  ii.s  spot  welding  and 
spray  painting  tasks,  which  do  not  involve  contact  of  the  end  effector  with  the 
environment.  These  tasks  do  not  require  precise  positioning  of  the  robots  and 
can  be  easily  handled  by  current  industrial  robots.  But  if  robots  are  to  be  used 
in  opei  ations  such  as  cariying  an  odd  shaped  part,  dexterous  end  effectors  with 
sensing  alrilities  are  needed. 

3.  In  assembly  operations,  manipulator  end  effectors  are  required  to  perform  small 
incremental  operations  for  precise  parts  mating.  Due  to  mechanical  and  con- 
ti’ol  considerations,  small  incremental  movcMiuaits  arc  not  possil)lc  with  lai'ge 
segments  of  jn-csent  day  industried  robots.  But  witli  the  help  of  dexterous  end 
effectors,  i-obots  can  be  used  to  pcriorm  assembly  operations  which  require  a 
lot  of  precision  without  the  involvement  of  large  segments  of  the  rnaniinilator. 
Tlie  la.i  ge  segments  of  the  manipulator  can  be  used  to  bring  the  end  effector 
into  the;  vicinity  of  the  assembly  operation,  which  would  tlien  be  completed  by 
precision  movements  witli  the  dexterous  end  effector. 

4.  Just  as  special  purpose  hands  are  currently  needed  to'  permit  different  oper¬ 
ations  by  the  manipulator,  a  special  purpose  fixture  is  required  for  holding  a 
particular  part.  With  a.  dexterous  hand  capability,  a  manipulator  could  serve 
as  an  adaptable  and  active  fixture  as  well.  Two  manipulators  could  then  work 
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togeUi(,-r  ill  an  assembly  operation,  one  liolcling  a  part  while  tlie  other  performs 
an  operation  on  it  [2]. 


With  a  dexterous  hand  capability,  robots  could  be  upgraded  from  stereotyped 
situations  such  as  assembly  lines.  Non-assembly  line  operations  such  as  maintenance 
and  repair  would  also  become  feasible. 

Due  to  the  above-mentioned  considerations,  researchei's  at  the  University  of  Utah 
and  Massaclmssetts  Institute  of  Technology  felt  the  need  to  design  and  build  a,  dexter¬ 
ous  hand  lor  research  purposes.  Their  primary  objective  was  to  design  and  construct 
a  geneial  purpose  research  tool  for  the  study  of  machine-based  manipulation.  From 
the  outset,  the  emphasis  was  on  producing  a  .system  with  extraordinary  perfoimance 
(botli  active  and  passive)  and  factors  related  to  cost,  powei'  consum|)tion  and  otlier 
piactical  considerations  were  de-empha.sized.  The  device  was  not  intended  for  near- 
term  application  in  an  industrial  environment.  Ratlier  it  was  intended  to  be  a  research 
tool  with  sufficient  functional  capabilities  to  permit  a  broad  variety  of  experiments, 
ihis  would  enable  researchers  to  understand  fundamental  concepts  and  machine  de¬ 
sign  issues  involved  in  the  study  of  dexterous  end  effectors.  After  several  years  of 
effort,  the  Center  for  Biomedical  Design  at  the  University  of  Utah  and  The  Artificial 
Intelligence  T.aboratory  at  the  Massachussetts  Institute  Of  Technology  (M.I.T.)  de¬ 
signed  and  developed  an  anthropomorphic  dexterous  robot  hand,  which  they  called 
The  UTAT'I/M.I.T.  DEXTEROUS  HAND.  The  Dexterous  Hand  (DM)  wa.s  de¬ 
signed  a,s  a,  .series  ol  modtdes  which  could  be  interchanged  for,  maintenance  purposes, 
permitting  reconfiguration  of  the  system  into  alternate  geometries  [4]. 


2.2  DESCRIPTION  OF  THE  UTAH/M.I.T.  HAND 

The  Ul.i)h/M.I.T.  hand  is  of  scini-antliropomorphic  size  and  design.  The  plio- 
l.ograpli  of  I, lie  Ul.ali/M.1.T.  Dexierotis  Hand  and  I, lie  line  diagram  of  I, he  same  arc' 
shown  in  figures  2.1  -  2.5  , 

Tlie  clioicc  of  seirii-anthropomorphic  (almost  Iniman-like)  geometiy  for  tlie  hand 
is  due  to  tlie  lollowing  three  reasons  : 


1.  J. he  human  hand  is  existing  proof  that  a  wide  varietj^  of  verj^  complicated, 
manipulative  tasks  can  be  accomplished  by  a  single  system,  provided  that  the 
end  effector  includes  sufficient  complexity  to  address  proposed  tasks  and  that 
the  control  system  and  its  sensors  are  adequate. 

2.  A  semi-anthropomorphic  configuration  allows  the  researclier  to  comi)are  tlie 
opera  tions  ol  the  robot  hand  with  operations  of  his  own  natural  hand. 


3.  A  semi-anthropomorphic  configuration  has  potential  application  as  a  slave  ele¬ 
ment  ill  a  tele-operation  sj^stem. 

The  hand  consists  of  ' 

1.  Three  lour  degrec-of-freedom  fingers. 

2.  One  four  degree-of-freedom  thumb. 

3.  One  three  degree-ol-freedom  wrist. 


1  he  thr(;e  fingers  a.nd  the  thumb  consist  of  three  parallel  a.xes  joints,  which  provnde 


the  curling  action.  The  fourth  joint  is  the  proximal  joint  which  is  perpendicular  to 
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Figure  2.5  Line  drawing  of  the  Utah/M.I.T.  Dexterous  Robot  Hand  [4] 


tlie  other  joints  (figure  2.6).  This  joint  provides  side-to-side  motion  (roll). 

2.3  COMPARISON  WITH  THE  HUMAN  HAND 

"I’lie  Ut;i,li/M.I.T.  hand  dilTers  from  tlic  human  hand  in  the  following  ways  : 

1.  Tlie  Utah/M.l.T.  hand  has  three  fingers  and  a  thumb,  wliile  the  human  hand 
has  four  fingers  and  one  thumb.  This  is  to  reduce  the  complexity  of  tendon 
routing  and  computational  complexities. 

2.  The  first  two  joints  of  each  digit  (the  0  and  1  joints),  shown  in  figure  2.6,  are 
sepa.ralcd  in  order  to  allow  tendons  to  be  routed  in  a  manner  which  results  in 
a  relialde  operation. 

3.  The  axis  of  joint  0  is  at  an  angle  of  12°  to  the  base  plane  (figure  2.6).  In  the 
human  liand,  the  0*^''  joint  axis  is  essentially  perpendicular  to  the  base  plane. 
This  (liffcrence  is  primarily  due  to  tendon  routing  limitations.  Also,  this  allows 
the  fingers  to  achieve  significant  side-to-side  movements  (0  joint  mobility)  When 
the  joint  1  is  flexed  to  the  90  degrees  position.  This  is  in  contrast  to  the  situation 
found  in  the  human  hand  where  0  joint  mobility  is  almost  null  when  joint  1  is 
fle.xcd  to  90  degrees. 

4.  The  fingers  and  thumb  of  the  Utah/M.l.T.  hand  ha.ve  a  side-to-side  motion,  in 
contrast  l.o  the  abdiiction/addnction  motion  of  the  luimaii  hand. 

5.  The  tliumb  of  the  Utah/M.l.T.  hand  is  placed  on  the  palmar  section  of  the  hand 
between  the  first  and  second  fingers,  which  is  unlike  the  human  hand. 


Ki 


This  cl  I  lows  l.cnclons  to  be  routed  over  the  wrist  and  through  the  palm  to  the 
thumb  ill  a  reliable  manner. 


().  The  wrist  joint  is  larger  than  the  liuinan  hand.  This  is  again  due  to  tendon 


routing  problems. 


The  hand  is  connected  to  the  wrist,  which  is  attached  to  the  remotizer  unit.  The 
remotizer  carries  tlie  tendons  from  the  actuator  package,  which  is  maintained  in  a 
static  position  by  an  externci.1  mounting. 


2.4  TENDONS 

Each  joint  is  driven  by  two  tendons,  thus  requiring  ‘2n’  tendons  to  drive  ‘n’ 
joints.  While  tendon  routing  became  complex,  the  decoupling  between  the  joints  is 
made  sijnple.  The  tendons  are  composite  structures  which  consist  of  Dacron  fibers 
woven  around  multiple  longitudinal  elements  ol  Kevlar.  The  Dacron  outer  slieath 
.serves  to  align  and  protect  the  internal  load  bearing  Kevlar  fibers.  Tendons  ])rovide 
a  number  of  advantages  including  very  low  mass,  and  the  possibility  for  stiff  trans¬ 
mission  of  energy  over  complex  pathways.  Tendons  require  no  bulky  terminal  energy 
translormation  systems  such  as  cylinders  used  in  hydraulic  systems  and  motors  with 
transmissions  used  in  electrical  sj^stems.  Tendons  arc  routed  throughout  the  hand  via 
sequences  ol  pi.ille\'- induced  bends  as  shown  in  figure  2.8.  The'pullej's  used  have  vaiy- 
ing  diameters  ol  .95,  .72,  .49  and  .38  inches  depending  on  the  location,  with  concave 
contact  surfaces  shaped  in  order  to  accomodate  the  cyllindrically  shaped  tendons. 
One  side  of  the  tendon  is  attached  to  the  piston  in  the  actuator  package  by  adapt- 
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ing  the  ovcrwrappcd  friction  lock  method  (A)  as  shown  in  figure  2.7.  The  tendon  is 
locked  via  a  supplemental  metal  screw.  The  other  side  is  attached  to  a  hard  stop  at 
the  joint  (C)  as  shown  in  figure  2.7. 

2.5  REMOTIZER 

The  Dll  was  initially  designed  to  be  positioned  in  space  by  a  manipulator  arm. 
However,  diu^  to  the  limited  capabilities  of  the  I, hen  existing  robots,  it  was  imlikelv 
that  the  entire  Dll  and  its  actuation  |)ackage  could  be  accurately  and  quickly  moved 
around  in  .spac.<'.  Ihuicc^  il.  was  dechh'd  to  construcl.  a.  r<'inotizing  systt'in  which  would 
enable  tlu^  actuation  package'  to  I'emain  in  astatic  position  with  respc'ct  to  the  1)11. 
Ihe  remotixlng  system  includes  32  tendon  pathways  in  four  subsystems.  Each  of 
these  subsystems  include  series  of  longitudinal  beams  and  roiling  joints  (figure  2.9). 
Tlie  longitudinal  beams  support  the  compressive  stresses  imposed  bj'^  tendons  and  the 
.system  ol  rolling  joints  permit  motion  of  the  remotizer  without  altering  tendon  path 
lengths.  This  configuration  includes  the  side  benefit  that  no  torques  are  imi)osed  on 
the  remotizer  joints  as  tendon  tensions  are  varied.  The  remotizer  is  then  a  passive 
sJ^stem  which  allows  the  DH  to  be  freely  positioned  in  space  while  the  Dll  receives 
substantial  energy  from  the  actuation  package  [4].  The  present  configuration  allows 
the  DH  to  be  positioned  everywhere  within  a  cube  of  sides  three  feet  long.  The  total 
remotizer  consists  oi  four  subsystems.  Figure  2.9  shows  the  four  subsj^stems  operating 
in  parallel  to  conduct  32  tendons  from  actuator  to  hand. 

Each  of  tliese  subsystems  include  the  following  ; 


Figure  2.7  Tendons  are  routed  over  pulleys  (B)  and  terminate 
cither  permanently  as  shown  in  point  (C)  or  in  a 
reversible  manner  shown  at  point  (A)  [4] 


Figure  2.8  Routing  of  tendons  throughout  the  system 

via  a  series  of  axial  twists  and  bends  over  pulleys  [4] 


Figure  2.9 


Oblique  view  of  the  centrel  joint  (elbow)  of  the  eemotizer  [4] 


20 


1.  Rolling-  joints  made  of  injection  molded  composite  materials  into  which  gears 
have  been  molded.  Figure  2.10  shows  tlie  side  view  of  the  central  remotizer 
joint  showing  rolling  action  of  the  remotizer  subsection.  The  orientation  of  tlie 
two  halves  ol  the  joint  is  maintained  by  coupling  members  and  the  gears  which 
constrain  the  joint  to  roll  in  a  manner  wliich  maintains  tendon  length  regardless 
of  angular  deflection  of  the  joint.  Each  rolling  joint  includes  16  pulleys  for 
tendon  routing  which  means  that  the  entire  remotizer  utilizes  288  pulleys  from 
the  actuation  package  up  to  tendon  tension  sensors  in  the  wrist. 


2.  Compression  lods  which  counteract  tendon  tensions  and  allow  axial  rotation  in 
oidei  to  add  degrees  of  freedom  to  the  remotizer  assembl3c 


1. he  lour  subsj’stems  must  be  flexibly  attaclied  in  such  a  wa.}^  as  to  maintain  tlieir 
g(’neral  coordination  while  permitting  simultan(X)us  rcTitive  motion  as  the  rf^rnotiziiig 
syslx^m  is  IxmiI,  and  twisted  [4]. 

The  advantages  gained  by  using  tendons  and  the  remotizer  are  twofold  ; 


1.  Less  weight:  1  he  hand  itself  can  now'  be  made  ver^'  compact  and  light. 

2.  Bigger  VVoi-kspacc:  Since  tlie  hand  is  attached  to  the  remotizer  unit,  the 
liand’s  workspace  is  supplemented  by  that  of  the  remotizer,  thus  increasing 
the  workspace  of  the  hand. 


21 


22 

2.6  THE  ACTUATION  SYSTEM 

The  acUiM.lioji  system  for  the  joints  of  the  Utah/M. I. T.  dexterous  hand  is  of  tlie 
pneumatic  type.  This  allows  for  a  low  weight,  compact  actuator  that  can  generate 
required  speeds  and  forces.  As  shown  in  figure  2.11,  each  joint  receives  two  tendons, 
driven  by  actuators  which  consist  of  pressure  controlling  valves  and  low  stiction  cylin¬ 
ders.  There  are  38  actuators  in  all,  two  for  each  joint.  As  shown  in  figure  2.12,  each 
module  contains  two  valves  (A),  two  actuator  cylinders  (B),  and  two  adjustable  pneu¬ 
matic  dampers  (C).  Each  valve  receives  an  electric  signal  which  generates  a.  cylinder 
])ressure.  S|)ring  tensioning  systems  are  included  within  cylinders  to  maintain  tendon 
tensions  wlien  the  system  is  unpressurized.  The  cylinders  for  actuation  and  damjhng 
are  constructed  of  glass  and  close  fitting  graphite  pistons.  This  configuration  operat¬ 
ing  at  low  pressures  (.50-100  psi)  permits  the  elimination  of  seals,  thereby  minimizing 
stiction  eflects.  The  dampers  whicli  o|)erate  in  a  pressurized  mode,  in  ordci’  to  in¬ 
crease  damping  and  minimize  compressibility  effects,  arc  adjustable  in  order  j,o  allow 
a  variable  trade-off  to  be  made  between  high  frequency  operation  and  stability  during 
free-space  operation.  The  actuator  modules  are  compactl}'  placed  in  a  4.25  x  4.25  x 
24  inch  rectangular  assenibly  containing  air  manifolds  and  weighing  20  pounds. 

Each  actuator  consists  of  a  two-stage  jet  pipe  valve  (figure  2.13).  The  first  stage 
is  electrically  driven  to  provide  a  pressure  signal  to  a  second  stage.  This  increase  in 
the  primary  stage  pressure  drives  the  second  stage  upper  diaphragm  downward  to 
deflect  the  jet  pipe  and  increase  cavity  pressure.  Piston  cavity  pressure  is  fed  back  to 
a  lower  diaphragm  such  that  tlie  valve  behaves  approximately  as  a  pressure  source 


Figure  2.11  of  joint  and  two  actuators  consisting  oflow 

st.ct.on  cylinders  and  pressure  controlling  valves  [4] 


Figure  2.12  A  dual  actuator  module  which 

includes  valves,  cylinders  and  dampers  [4] 
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inodulalccl  by  an  input  current  [4]. 

2.7  SENSORS 

'I'licrc  arc  two  kinds  of  sensors  incorporated  in  the  hand,  namely 

Joint  Aii«^le  Sensors  :  The  joint  angle  sensors  are  llall-cfFect  devices,  located  at 
the  sides  of  each  joint.  These  sensors  provide  accurate  joint  angle  information 
for  control  purposes.  These  sensors  are  reliaJ)le,  compact  and  proj)ortiona.l.  The 
sensoi  s  |)iodnce  a  voltage  that  is  |)roportiona.l  to  the  nuiasured  angular  displace¬ 
ment.  Helerring  to  figure  2.14,  (A)  is  a  inaguetically  sensitive  Hall  effect  device 
located  in  the  proximal  link,  while  (B),  attached  to  the  distal  link,  includes 
two  cobalt  samarium  magnets  operating  in  a.  dipole  configuration.  As  the  Hall 
effect  (hw'icc^  sw(;eps  (.he  magnel.ic  field,  it  produces  an  oul.put  current  whicli  cor¬ 
responds  to  the  angular  deflections  between  0  and  95  degrees  with  a  linearity 
within  5%.  The  Hall  effect  sensor  system  includes  a  number  of  advantages  such 
as  continuous  operation,  low  friction,  high  bandwidth  operation,  no  mechanical 
contael.,  long  life,  and  tolerance  to  surrounding  contaminants. 

2-  Tendon  Tension  Sensors  :  Tendon  tension  is  monitored  in  order  to  obtain  torques 
imposed  on  individual  joints.  This  inforrnal.ion  is  ]novided  to  the  controller  for 
actuator  compensation.  Ideal]}',  tendon  tension  sensors'would  be  installed  dis- 
tally  at  the  insertion  of  tendons  at  each  joint  and  proximally  at  the  output  of 
each  actuator.  However,  clue  to  packaging  problems  and  other  issues,  a  com¬ 
promise  system  was  selected.  The  sensors  were  mounted  at  the  wrist.  Each- 


Figure  2.14  Configuration  of  the  Hall  effect  sensors 

used  to  measure  angular  deflection  of  the  joints  [4] 


Figure  2.1S  Configuration  of  the  32  tendon  tension 

sensors  located  in  the  wrist  of  the  Dexterous  Hand  [4] 


sensor  uses  a.  semiconductor  strain  gauge  bridge  to  monitor  tiie  beam  deflection, 
wliicli  is  proportional  to  the  tendon  tension.  As  shown  in  figure  2.15,  tl>e  pulle}^ 
is  positioned  in  order  to  perturb  the  path  of  the  tendon  such  that  tendon  tension 
imposes  a  load  on  the  cantilevered  beam.  A  semiconductor  strain  gauge  bridge 
detects  beam  strain  and  provides  a.  linear  output  for  tendon  tensions  from  0  to 
30  pounds  [4]. 

The  above  discussion  described  different  components  of  the  Utah/M. T.T.  De.x- 
terous  Hand.  Next  chapter  deals  with  the  description  of  the  dexterous  hand  analog 


III.  THE  DEXTEROUS  HAND  ANALOG  SERVO 

CONTROLLER 

Figure  2.1  sliows  the  pliotograph  of  the  DM  analog  servo  controller.  Tlie  analog 
controller  is  described  in  detail  in  the  following  section. 

3.1  DESCRIPTION 

j 

The  De.xterons  Hand  control  system  comprises  of  a  .500  watt  power  supply,  a  cool¬ 
ing  Ian  pack,  and  a  card  cage  containing  an  analog  l)ased  ])Osition/(orce  servo  feedback 
controller.  'I'he  analog  controller  section  consists  of  8  servo  cards,  a.n  inpnt/ontpnt 
card,  and  2  spare  slots  reserved  for  wrist  control  and  master  conditioning.  Each  of 
the  eight  sei  \o  cards  compi'ises  of  2  joint  controllers.  Each  joint  cont, roller  has  its 
own  circuitry  lor  signal  conditioning  (joint  angles,  joint  velocities,  and  joint  (endon 
tensions),  signal  processing,  and  power  drivers  for  tlie  actuators. 

The  Low  Level  Control  System  (LLCS)  includes  in  all  16  variable-loop-gain  po¬ 
sition  servos  to  operate  finger  joints  and  32  variable-loop-gain  tension  servos  to  mod¬ 
ulate  actuator  behavior  in  order  to  control  tendon  tensions.  Amplification  and  signal 
conditioning  circuitry  is  also  included  to 

1.  provide  current  soui’ces  for  driving  pneumatic  valves, 

2.  drive  and  monitor  joint  angle  sensors,  and 
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Bf  (Cocontraction  input) 


Figure  3.2  Position  control  loop  of  a  singlo  Joint 
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3.  drive  and  monitor  tendon  tension  sensors. 

The  system  inputs  include: 

1.  16  inputs  lor  control  of  angular  position, 

2.  32  inputs  for  control  of  desired  tendon  tension, 

3.  16  inputs  to  vary  position  servo  loop  gain,  a.nd 

d.  32  inj)nt.s  to  vary  tendon  tension  sei  vo  loop  gain. 

Also,  a  number  of  auxiliary  inputs  are  available  to  control  damping,  cocontraction 
levels  (  explained  in  detail  in  the  latter  half  of  tlie  chapter)  and  to  allow  direct  control 
ol  servo  valvc'  currents  [d].  This  allows  the  analog  controller  to  operate  either  in  a 
stand  alone  mode,  requiring  no  digital  electronics,  or  in  conjunction  with  tlu'  digital 
system.  1  he  digital  system  can  sup])ly  desired  angles,  tendon  tensions,  cocontracl  ion 
levels,  positional  gains,  damping  gains,  and/or  I.endon  tension  gains.  The;  digital 
system  also  has  access  to  scaled  analog  voltages  corresponding  to  any  of  the  semsor 
signals  [f)]. 

3.2  CONTROL  OF  A  SINGLE  JOINT 

The  sclK'inatic  of  the  control  setup  for  a  single  joint  is  as  shown  in  figure  3.1. 
1’he  block  diagram  of  the  single  joint  control  is  as  shown  in  figure  3.2.  The  analog 
contiollei  is  ol  the  proportional-plus-defivative  type.  Tlie  analog  controller  has  a 
slightly  diflerent  configuration  (figure  3.2)  than  that  of  the  conventional  proportional 


l)lus  dcrivalivc  control  sclicme.  Tlic  difrercnce  in  con/ign ration  is  because  tlie  move¬ 
ment  of  a  joint  is  effected  by  the  interaction  of  the  two  actuation  systems  (flexion  and 
extension)  set  up  in  an  antagonist  configuration.  The  flexion  and  extension  of  a  joint 
is  shown  in  figure  3.3.  A  joint  is  defined  to  be  flexing  when  the  finger  curls  inwards. 
This  movement  is  effected  when  the  flexor  tendon  is  pulled.  A  joint  is  defined  to  be 
extending  when  the  the  finger  moves  outward.  This  movement  takes  place  when  the 
extensor  tendon  is  pulled  by  the  extensor  actuation  system.  The  movement  of  a  joint 
lakes  place  not  due  to  the  force  acting  on  flexor  or  extensor  tendons  only,  but  due, 
to  the  difleience  in  the  forces  acting  on  tlie  flexor  and  extensor  tendons. 

The  proportional  plus  derivative  tyiie  controller  uses  a  .scMies-fcedback  configu¬ 
ration  as  shown  in  the  block  diagram  of  figure  3.d  [6].  The  derivative  part  of  tlie 
controller  is  placed  in  the  leedback  path,  while  the  proportional  part  is  [ilaccd  in  se¬ 
nes  with  the  plant.  The  actual  position,  sensed  by  the  position  Hall  effect  sensors,  is 
ted  back  as  a  scaled  voltage  between  -lOV  and  +10V.  When  tlie  finger  is  straight  out 
i.e.  lully  extended,  the  joint  angle  is  zero  radians,  whicli  corresponds  to  -  lOV  output 
of  the  Hall  effect  sensor.  As  the  finger  flexes,  the  joint  angle  increases  positivel}'  from 
0  radians  and  the  transducer  output  increases  positive!}'  from  -lOV  to  +10V.  This  is 
shown  in  figure  3.5,  where  the  non-zero  joint  angles  are  represented  as  where  .x 
denotes  the  finger  and  y  denotes  the  joint.  When  the  finger  is  fully  flexed,  the  joint 
angle  is  maximum  and  the  transducer  output  is  -f  lOV  (the  calibration  of  the  joint 
angle  sensors  is  discussed  in  the  next  chapter).  Tlie  desired  position  (Oj)  and  the 
actual  position  (d„)  in  radians  is  converted  to  desired  and  actual  position  in  volts  by 
m'^ltipb'ing  with  the  transducer  (Hall  effect  sensor)  constant  Kj,  as  sliown  in  figure 
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Figure  8.5  Line  drawing  of  the  Utah/M.I.T.  DH  showing  joint  angles  [7] 
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3.2.  Tills  can  be  represented  as 


Si 

II 

(3.1) 

II 

p 

(3.2) 

The  error  between  the  desired  and  the  actual  position  voltage  is  passed  through 
a  position  gain  potentiometer,  whose  gain  Kp  can  be  varied.  This  can  be  written  as 

Mp  =  Kj,[Vd-V„]  (3.3) 

where 

Ap  -  spring  constant  or  stiffness  in  Ib-in/volt 

Vfi  -  desired  angular  position  in  volts 

Va  -  actual  angular  position  in  volts 

Mp  ~  rnonient  generated  due  to  positional  error  in  lb-in 

J. he  actual  |)osition  voltage  Va  is  passed  through  a  differentiator,  and  then  to 
a  velocity  gain  control  potentiometer  which  has  a  variable  gain  Ky,  This  can  be 
represented  as 

=  (3.4) 

hy  -  viscous  Irictioiial  coefficient  in  Ib-in/volt/sec. 

My  -  moment  generated  due  to  the  actual  velocit.y  of  .joint  in  lb-in. 

Kf  -  gain  lactor  associated  with  the  diflerentiator  circuit. 

These  moments  are  then  passed  through  half-wave  rectifiers  whose  operating 
characteristics  are  shown  in  figure  3.6.  The  R+  and  R~  operators  in  figure  3.6  can 
be  represented  matliematically  as 


(3.5) 


.‘5!) 


yr(.T)  =  l/2[-.r  +  |.7:|]  (3.0) 

where  x  is  the  input  to  the  half-wave  rectifier. 

The  operator  suppresses  all  negative  moments,  and  allows  only  positive  mo¬ 
ments.  This  side  is  known  as  the  flexor  tendon  system  and  the  output  of  the  rectifier 
is  essentially  the  desired  flexor  tendon  tension.  The  R~  operator  supi^resses  all  pos¬ 
itive  moments  and  allows  only  negative  moments,  tins  side  is  known  as  the  extensor 
tendon  system  and  the  output  of  the  half- wave  rectifier  is  essentially  the  desired  ex¬ 
tensor  tendon  tension.  Thus,  at  anj^  particular  time,  moment  is  being  applied  either 
to  tlte  flexion  trmdon  system  or  to  the  extension  tendon  system.  When  moment  is 
being  applied  to  one  system,  the  tendon  tension  in  the  other  system  is  zero  i.e.  the 
tendon  goes  sla.ck.  This  can  be  seen  in  figure  3.7,  which  shows  the  underdamped  step 
response  and  the  flexion  and  extension  tendon  tension  of  a  joint. 

The  step  input  is  shown  in  dotted  lines.  It  is  evident  from  figure  3.7  that  wlicn 
the  eri’or  between  the  desired  and  actual  position  is  positive,  the  flexor  tendon  tension 
exhibits  a  non-xero  value  and  the  extensor  tendon  tension  is  zero.  When  tlie  error 
is  negative,  I, lie  extensor  tendon  tension  is  non-zero  and  the  flexor  tendon  is  at  zero 
tension  state,  i.e.  tlie  tendon  goes  slack.  Also  spikes  appear  when  tendon  tensions 
changes  from  z( wo  to  a.  non-zero  value.  This  ))henom(Mion  is  known  as  snapping  of 
tendons.  Hence,  to  avoid  the  zero  tension  state  when  no'  moment  is  applied  to  the 
system,  a.  constant  bias  term  is  added  on  both  the  flexion  and  extension  sysU'in.  'I’his 
bias  term  is  known  as  cocontraction.  Biologists  refer  to  this  term  in  humans  as 
co-activatiori.  Tlie  effect  of  cocontraction  can  be  seen  in  figure  3.8.  The  tendons 


never  go  lo  zero  tension  state,  in  other  words,  tlie  tendons  never  go  slack.  Tliis  rc'sults 
in  the  elinniwition  of  the  snapping  action.  Tlie  tendon  jnana.gcinent  discussed  above 
can  be  rnatheinatically  represented  as 


where 

I'jfi  “  desired  flexion  tendon  tension 

lai  -  desired  extension  tendon  tension 

Bj  -  flexion  bias  (cocontraction  input  to  the  flexion  sj'stem) 

Be  -  extension  bias  (cocontraction  input  to  the  extension  system) 

The  analog  control  sj^stem  uses  a  force  feedback  loop  on  each  tendon  to  regulate 
the  moments  applied  to  tlie  finger  joints  by  the  pneumatic  actuators.  This  includes 
lineai'izing  l.lu'  actuator  and  removing  the  effects  of  stici.ion  in  tlu'.  t.cmdon  pulley 
system.  The  actual  tendon  tension  is  detected  by  the  tendon  tension  sensors  located 
at  the  wrist  joint.  The  gains  /Vg  ^^d  Kj  determine  the  stiffness  of  the  force  loop.  The 
desired  torejues  or  moments  obtained  to  produce  desired  tendon  tensions  are  signal- 
conditioned  and  a  proportional  current  is  applied  to  the  valve.  The  valve  outputs 
an  equivalent  pressure  which  drives  the  actuation  system.  Tlie  actuator  pulls  on  the 
tendon  which  results  in  the  movement  of  the  joint. 


3.3  DEXTEROUS  HAND  CONTROL  DEVELOPMENT 
SYSTEM 

Tlie  current  Utah/M. I.T.  Dexterous  Hand  (DH)  control  development  s^-stein 
hardware  is  shown  in  figure  3.9.  The  control  development  system  was  developed 
for  the  following  reasons  : 

1.  To  perfoi  rn  different  tests  on  the  DH. 

2.  To  conduct  frequency  response  analysis  in  order  to  identily  tlie  transfer  func¬ 
tions  of  different  joints  and  that  of  coupling  between  different  joints  of  tlie 
Utah/lVI.T.T.  DH. 

3.  To  set  the  various  parameters  of  the  analog  servo  controller  to  different  values. 

4.  To  slave  the  DH  to  an  exo-skeleton  master  worn  b}'  a  human  operator. 

The  major  components  of  the  DH  control  system  hardware  are  described  below. 

3.3.1  IBM  PC-AT 

TffE  IBM  PC-AT  acts  as  a  host  for  software  development  to  slave  the  DH  to 
an  exo-skeleton  master  worn  by  a  human  operator  and  for  system  operation.  It 
has  2  Mbytes  of  RAM,  a  30  Mbyte  hard  disk,  dual  floppj^  disk  drives,  a  Hercules 
monochrome  graphics  adaptor,  80287  math  chip,  2  serial  ports,  3  printer  ports,  and 
MS-DOS  v3.10.  Two  printer  ports  are  u.sed  for  the  printer  and  plotter  (figure  3.9). 
A  serial  port  is  used  to  link  the  PC  to  the  VMEbus  system.  This  enables  different 
commands  to  be  given  to  the  dexterous  hand  analog  servo  controller  from  tlie  PC. 
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Figure  3.9  CONTROL  SYSTEM  BLOCK  DIAGRAM  FOR  THE 

UTAH/M.I.T.  DEXTEROUS  LEFT  AND  RIGHT  HAND  SYSTEM 


Available  languages  for  developing  PC  applications  include:  Turbo  C,  Fortran, 
Turbo  Pascal,  and  assembly.  All  DU  software  lias  been  developed  using  Turbo  C 
and  MC802S()  Assembly  (80286/80287).  A  library  of  routines  for  creating  data  files 
in  a  standard  format  and  accessing  tliem  has  been  developed.  Libraiy  routines  for 
downloading  and  uploading  raw  data  files  plus  a  terminal  emulator  with  download 
support  are  available.  Also  spoolers  and  queue  managers  for  plots  and  data,  tables 
have  been  developed.  A  library  of  routines  for  the  I/O  devices  (serial  ports,  analog 
to  digital  convcrtei’s,  digital  to  analog  converters,  a  Random  Access  Memory  file  and 
timer  interrupt  services)  is  available. 

3.3.2  VMEBUS  CHASSIS 

The  VlMFbus  chassis  contains  a  system  controller  board  (Ironies  lV-3273)  vvith 
2  serial  ports,  2  i)arallel  ports,  a  clock/calendar,  and  an  SCSI  interface.  The  console 
serial  port  is  used  to  link  the  VMEbus  system  to  the  PC  host. 

There  is  one  CPU  board  (Ironies  IV-.3201)  with  a  16  Mllz  68020  j^rocessor  and  a 
68881  math  co-processor.  It  has  1  Mbyte  of  dual-ported  RAM,  an  EPROM  monitor 
(IMON  3201 ),  and  a  timer/counter  chip.  The  monitor  comes  up  on  the  console  serial 
|rort  and  can  be  used  directly  wil.h  a  terminal  emulator  program  in  tlie  PC  host. 

There  are  two  A/D  (analog  to  digital)  converter  boards  (Data.  Translation  DT- 
1401).  Each  board  has  32  12-bit  A/D  channels  and  2  12-bit  D/A  channels.  To  match 
the  Sarcos  controller,  the  analog  ranges  are  set  from  -10  to  -1-10  volts  full  scale  (giving 
a.  re.solution  of  4.88mV/count). 

There  are  three  D/A  converter  boards  (Data  Translation  DT-1406-8V)-  Each 


If; 


hoard  lias  12-hit;  D/A  channels.  As  with  the  A/D  hoards  the  analog  ranges  are 
set  Irom  -JO  to  -flO  volts  full  scale.  The  D/A  converters  lia.ve  a  inaxinuini  1/2 
Least  Significant  Byte  accuracy,  settling  time  (for  a  full  scale  step)  of  S//,.sec.  and  a 
5  V///,sec.  slew  rate.  Totally,  there  are  ()4  ADC  (analog-to-digital  channels)  and  28 
DAC  (digital-to-analog  channels)  available. 

3.3.3  SARCOS  DH  CONTROLLERS 

ddie  two  Sa.rcos  DH  controllers  for  the  left  and  right  de.xterous  hands  ha\-c  several 
modes  ol  computei’  controlled  operation  ranging  from  position  servo  to  force  servo 
to  direct  valve  control.  All  T/0  (input/output)  with  the  controllers  is  done  through 
analog  signals  (-10V  to  +J  0V).  Each  controller  can  accept  up  to  112  command  signals 
output  from  a.  computer. 

Since  only  a  very  few  of  the  many  possible  connection  patterns  will  be  needed 
at  any  time,  diflerent  cables  were  made  to  connect  different  parts  of  the  controller  to 
the  ADC/ DAC.  Currently  three  cables  are  available:  the  first  connects  all  C4  data 
signals  from  the  controller  to  the  64  ADC.  The  second  connects  the  28  DAC  to  all 
tlie  possible  command  signals  for  one  finger  of  a  DH.  The  third  connects  16  DAC  to 
the  16  command  positions  of  a  controller  plus  1  DAC  to  all  16  position  gains,  1  DAC 
to  all  16  velocity  gains,  1  DAC  to  all  32  tension  gains  and  1  DAC  to  all  32  tension 


biases. 


3.3.4  DATA  ACQUISITION  SOFTWARE 

In  addil.ion  to  tlie  hardware  and  software  development  tools,  a  simple!  tlala  ac¬ 
quisition  system  is  available.  The  Data  Acquisition  and  VVavelorm  Generator  System 
(DAVVGS)  allows  27  DAG  outputs  to  be  set  to  constant  values  and  one  DAG  output 
to  generate  a.  sine  or  scpiare  wave  function.  While  the  output  function  is  occuiring, 
up  to  20  ADC  inputs  may  be  recorded.  Data  loops  can  be  recorded  at  2-50  //.sec.  (for 
Tor  2  channels),  at  500  //sec.  (for  9  or  less  channels)  or  at  1000//sec.  intervals.  .Ap¬ 
proximately  400,000  ADC  samples  could  be  recorded  in  a  single  data  set.  Recorded 
data  may  be  tabulated  of  plotted  versus  time. 

Tlie  information  on  tlic  Dll  control  development  system  has  been  pro\’ided  by 
Systems  Res(!arch  Laboratory,  who  developed  the  system.  Ihe  calibration  ol  the 
various  gain  blo(;l\S  in  the  a.nalog  servo  controller  and  (.hose  ol  the  joint  angh.'  and 
position  sensois  is  discussed  in  tlie  next  clia|dicr. 


IV  .  CALIBRATION 


Many  ahI)rcviirl,ions  are  used  in  this  chapter.  The  explanation  of  these  abbrevi¬ 
ations  arc  given  in  Appendix  A. 

4.1  NEED  FOR  CALIBRATION 

As  nienljoncd  in  the  previous  chapter,  each  joint  controller  contains  the  following 
gain  blocks  (figure  4.1)  : 

1.  Position  gain  block  (GP) 

2.  AAlocity  gain  block  (GV) 

3.  Flexion  gain  block  (GF) 

4.  Extension  gain  block  (GE) 

These  gain  blocks  are  built  with  the  help  of  operational  amplifiers  and  poten¬ 
tiometers.  The  potentiometers  act  as  voltage  dividers.  One  end  of  the  potentiometer 
is  connected  to  — lOV  while  the  other  end  is  connected  to  +10V.  Dej^ending  on  the 
voltage  setting,  the  potentiometer  has  a  gain  value  varying  from  0  to  10.  Hence,  the 
potentiometers  need  to  be  calibrated  to  determine  the  gains  produced  corresponding 
to  their  voltage  settings.  Also,  each  joint  has  a  position  Hall  effect  sensor  and  a 

tendon  tension  sensor.  The  Hall  effect  sensor  outputs  a  voltage  corresponding  to 
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(Cocontraction  input) 


Block  diagram  of  the  position  control  loop  of  a 
single  joint  showing  the  various  blocks  to  be  calibrated 


■)! 

tlio  joiiil,  aii,u;lc,  vyiUi  a  proportionality  constant  K-p  as  sliovvn  in  figure;  '1.1.  'J'Ik; 
relationsinj)  between  the  voltage  output  of  the  sensor  and  the  joint  angle  needs  to  be 
determined.  Similarly,  the  tendon  tension  sensor  outputs  a  voltage  projjortional  to 
the  tendon  tension  measured.  This  sensor  needs  to  be  calibrated  to  determine  the 
relationship  between  the  voltage  produced  and  the  tendon  tension. 

4.2  CALIBRATION  OF  THE  GAIN  BLOCKS 


I  h<’  position,  e.xtension  and  fle.xion  gain  blocks  incorporate  both  tlu'  summing 
block  and  iJie  gain  block  in  one  operational  aniplific-r  unit.  'I'he  position  gain  block 
has  two  inputs  namely  desired  position  (PI))  and  actual  position  (POS)  (figure  T2.). 

ihe  Cl  lot  between  the  two  is  multiplied  by  a  gain  factor.  The  gain  factor  was 
calculated  by  dividing  the  output  (PGO)  by  the  difference  between  the  two  ininits  of 
the  operational  amplifier  (PD  and  POS),  obtained  for  different  values  of  gain  voltage 
setting.s  (Gb)  varying  from  -lOV  to  +10V.  The  gain  factors  of  the  position  gain  blocks 
of  hl.JO  and  I'd.Jl  were  plotted  against  the  corresponding  potentiometei'  settings  (in 
volts)  lor  two  different  values  of  desired  and  actual  input  voltages  (figure  4.3).  The 
two  slopes  differed  slightly  from  each  other  only  for  the  high  gains,  while  for  the  low 
gaiias,  tliey  were  very  much  the  same.  The  calculations  arc  shown  in  Appendix  B. 
Since  the  diflerences  were  small  lor  the  high  gains,  a.  straight  line  was  fitted  through 
these  points,  wliicli  took  tlie  average  of  these  values.  Thus  the  relationships  between 
the  gain  sel.ting  in  volts  and  the  gain  factor  for  FIJO  and  FIJI  were  determined.  The 
calibration  plots  and  tables  of  F1.J2  and  F1.J3  are  shown  in  Appendix  B. 


Position  gain  block  calibration 
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Figure  4.3  Position  gain  block  calibration 


The  flexion  (extension)  gain  block  calibration  was  carried  out  in  the  same  manner. 
Tlie  difrerence  between  the  desired  input  FD  (ED)  and  tlie  actual  input  FLX  (EX'P) 
is  calculated  as  the  input  error.  The  gain  factor  of  the  flexion  (extension)  gain  block 
was  obtained  by  dividing  the  gained  outj^ut  FGO  (EGO)  by  the  input  error  between 
FD  (ED)  and  FLX  (EXT)  for  different  values  of  the  gain  voltage  settings  GF  (GE) 
varying  from  -  lOV  to  +10V.  The  block  diagrams  of  the  flexion  and  extension  gain 
blocks  is  giv('n  in  figures  4.4  and  4.5  respectively.  The  gain  .settings  in  volts  of  the 
flexion  (extc.'iision)  blocks  of  FIJO  and  FIJI  were  plotted  against  the  gain  factors  as 
shown  in  figure  4.6  (figure  4.7).  Thus  the  relationship  between  the  gain  settings  and 
gain  factoi's  for  the  above-mentioned  gain  blocks  were  determined.  The  calibration 
tables  and  plots  of  FIJI,  F1J2  and  F1J3  are  given  in  Appendix  B. 

The  calibration  of  the  velocity  gain  block  (figure  4.8)  was  carried  out  in  a  slightly 
different  manner,  because  there  is  only  one  input  (  actual  velocity  (VEL)).  Tlie  gain 
voltage  (GV)  was  varied  from  -lOV  to  +10V,  and  the  gained  output  voltage  was 
measured.  'This  procedure  was  repeated  for  different  values  of  the  input  (VEIj).  The 
gain  factor  was  obtained  by  dividing  the  output  by  the  input  error  (which  is  tlie  same 
as  the  actual  input).  The  gain  setting  in  volts  was  plotted  against  the  gain  factor  as 
shown  in  figure  4.9,  which  shows  plots  for  FIJO  and  FIJI.  The  gain  factor  was  the 
same  for  botli  values  of  the  input.  The  calibration  tables  and  graphs  of  the  velocity 
gain  blocks  of  FIJI,  F1J2  and  F1J3  are  given  in  Appendix  B. 
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Figure  4.7  Extension  gain  block  calibration 
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Figure  4.8  Velocity  gain  block 


Figure  4.9  Velocity  gain  block  calibration 
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4.3  CALIBRATION  OF  THE  JOINT  ANGLE  SENSORS 

The  joint,  angle  sensors  are  the  Hall  effect  sensors,  located  at  the  side  of  each 
joint.  The  seii.sor.s  jjroduce  a  voltage  proportional  to  tlie  angular  dis|:)la.cenicnt.  The 
sensors  were  calihi'ated  with  tlie  help  of  an  ‘El  13  Series  Miniature  Increinental  Rotary 
Optical  Encoder’  (figure  4.10). 

The  El  13  encoder  provides  high  precision  angular  position  and  velocity  signals. 
The  design  consist. s  of  a  ])atented  glass  disc  and  liub  asseinbly,  focused  inlrai  ed  light, 
.source,  a.  monolithic  |)hotodetector  array  and  signal  conditioning  electronics.  For  a 
360°  rotation,  the  encoder  outputs  1024  i)ul.ses.  By  mounting  the  optical  encoder 
on  the  side  of  the  joint,  the  rotation  of  the  joint  can  be  determined  by  count.ing  the 
numbei'  of  |)nlses  outputted  by  the  optical  encoder.  Tliis  gives  an  accurate  measure 
of  the  joint  atigle  displacomient.  The  joint  angle  is  ca.lculated  using  the  lormula 

=  — X  1024  degrees  (4.1) 

3G0 

where 

0  -  joint  angle  displacement 
X  -  number  of  pulses  outputted. 

After  pr(>calil)ia.ting  the  optical  encoder  as  ex]daincd,  the  encoder  was  mounted 
on  the  side  of  joint  1  of  finger  1.  The  joint  was  moved  from  0  do^gices  |)osition  to 
full  scale  defiectiou  and  moved  back  to  0  degrees.  The  output  voltage  ol  the  Hall 
effect  semsoi'  was  passed  through  an  A/D  converter  and  read  off  as  counts.  This  was 
compax'ed  to  the  pre-ca.librated,  standardized  output  of  the  El  13  optical  encoder. 
The  counts  of  tlie  A/D  converter  (POS-FLJl)  was  plotted  against  the  pre-calibrated 


Figure  4.10  EllS  Seies  Miniature  Incremental  Rotary  Optical  Encoder 


output  (in  degrees)  of  the  encoder  (ENC-FIJI),  as  shown  in  figure  4.11,  and  a  straight 
line  was  fitted  through  these  points.  This  was  done  to  determine  the  equation  that 
would  convert  the  i)osition  reading  (in  counts)  ot  the  Hall  effect  sensors  obtained  from 
the  A/D  converters  into  position  reading  (in  degrees).  This  j)rocedure  was  repeated 
two  more  timers  to  test  the  joint  angle  sensor  for  coiusistency  .  Tlie  values  obtained 
were  tabulated  as  shown  in  Appendix  B.  It  can  be  seen  from  figure  4.11  that  the 
Hall  effect  sensor  produced  consistent  results  all  the  three  times.  Tlie  equation  of 
conversion  of  the  position  reading  (counts)  to  the  position  in  terms  of  d(igr(X's  is  given 
in  Table  BIT  in  ApjK'.ndix  B.  The  Hall  effect  sensors  were  found  to  be  linear  with 
an  error  of  ±  0.5  degrees.  The  calibration  plots  and  tabulations  of  tlie  position  Hall 
effect  sensor  of  FlJ2and  Fl.)3are  shown  in  Appendix  B.  Joint  0  of  all  iJie  four  fingers 
could  not  be  calibrated  in  the  same  manner,  because  it  was  impossible  to  mount  the 
encoder.  So,  an  approximate  measure  of  conversion  obtained  from  the  calibration 
results  of  the  otlier  joints  wa.s  used  since  the  Hall  effect  sensors  used  were  of  the  same 
kind. 

4.4  CALIBRATION  OF  THE  TENDON  TENSION  SEN¬ 
SORS 

The  l.eiulon  (.elision  sensors  were  calibrated  using  a  load  cell.  A  load  cell  is  a 
transducer  device  that  produces  an  output  that  is  proportional  to  an  applied  force. 
The  load  cell  which  was  used  for  the  calibration  is  of  the  strain-gage  type.  The  load 
cell  u.se.s  strain-gages  to  sense  tlie  force  or  tendon  tension  and  output  a  prp|)<.)rtional 
voltage.  Jiiilially,  the  load  cell  Was  ca.libral.ed  by  hanging  known  weights  and  noting 


the  voltage  output  (in  counts)  which  was  obtained  by  passing  the  output  of  the  load 
cell  tlirough  an  A/D  converter.  Once  the  load  cell  was  calibrated,  the  flexor  tendon 
of  FIJO  was  disconnected  from  the  actuator  box  and  connected  to  a  rigid  assembly,  to 
which  was  attached  the  load  cell.  The  tendon  was  tightened  slowly  which  increased 
the  tension  from  0  Ibf  to  10  Ibf.  The  tendon  was  then  loosened  which  decreased  the 
tendon  tension  to  0  Ibf,  and  the  output  of  the  tendon  tension  sensors  (in  counts)  was 
read  from  the  A/D  converters.  These  values  were  compared  with  the  pre-ca,libra.ted 
output  ol  the  load  cell.  The  results  are  tabulated  as  shown  in  Appendix  13.  The  tendon 
tension  sensor  readings  (in  counts)  were  plotted  against  tlie  pre-calibrated  output  (in 
Ibt)  of  the  load  cell  (figure  4.12).  A  straight  line  fit  was  done  on  these  points  and 
the  equation  of  conversion  was  determined  (given  in  Table  B27  in  Appendix  13).  Tliis 
procedure  was  repeated  for  a  tension  range  of  0-20-0  Ibf  and  0-30-0  Ibf.  I'lie  plots 
ol  all  the  three  ranges  ai-e  sliown  in  figure  4.12.  It.  can  be  seen  from  t.liese  figures 
that  there  is  liystcresis,  and  that  the  hysteresis  effect  increased  with  the  increase 
in  the  range  of  measurement,  i.e.  the  hysteresis  effect  was  more  for  the  0-30-0  Ibf 
range  of  measurement  than  for  the  0-20-0  Ibf  range.  This  effect  might  have  been  due 
to  the  hysteresis  effect  of  the  pulleys  through  which  the  tendons  are  routed.  The 
calibration  ol  the  fle.xion  and  extension  tendon  tension  sensors  of  all  the  other  joints 
was  conducted  in  the  same  manner.  The  tabulation  and  plots  of  the  results  are  given 
in  Appendix  B. 


Figure  4.12  Flexion  tendon  tension  sensor  calibration 
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4.5  DETERMINATION  OF  THE  BIAS  SETTINGS 

As  mcnUoiiecI  in  the  previous  chapter,  a  bias  voltage  known  as  coconiractioii 
needed  for  both  the  flexor  and  extensor  tendon  tension  to  prevent  either  of  tlie  tendons 
from  going  to  a  zero  tension  state.  When  there  is  no  cocontraction  input,  the  tendons 
go  to  zero  tension  state  or  become  slack.  When  they  are  brought  back  to  a  tensioned 
state,  there  is  a  sudden  sna.])  which  shows  up  as  spikes  in  the  tendon  tension  plot,  are 
undesirable. 

The  procedure  followed  for  deterjnining  the  bias  settijig  is  as  follows.  The  position 
loop  and  the  force  loop  (figure  4.1)  were  closed.  The  extensor  and  flexor  blocks  were 
adjusted  to  have  a.  flexor  a.nd  extensor  gain  of  4.  This  was  done  to  ensure  that  tlie 
force  loop  remains  stiff.  Figures  4.13  and  4.14  show  the  plots  obtained  for  the  bias 
determination  of  l‘T,]3.  3'he  values  to  which  the  various  other  ])arameters  were  set 
to  are  shown  in  figures  4.13  and  4.14.  The  biases  Be  -  ]'’].J3  and  Bf  -  F1.J3  were 
initially  set  at  -lOV.  A  sine  wave  of  frequency  5  hertz  was  applied  to  the  input  to  the 
servo  loop  {BD-F1.J3).  TJie  actual  position  B0S-F1J3  ,  flexion  tendon  tension  FLX- 
F1.J3  and  extension  tendon  tension  EXT-F1J3  were  recorded.  The  biases  B^.  and  Bf 
were  increased  until  the  spikes  in  the  plots  of  FLX-F1J3  and  EXT-F1J3  disappeared. 
Figure  4.13  shows  the  position  and  tendon  tension  plots  of  F1.J3  for  a  bias  of  -5.2 
volts.  The  spikes  can  be  .seen  in  the  plot  of  the  output  of  the  flexion  tendon  tension 
sensor  FbX-l‘'l.)3  when  the  tendons  reach  0  (.ension  state  (-10V).  Figure  4.1  I  shows 
the  plots  for  a  tension  of  -3.6  volts.  It  can  be  seen  that  the  spikes  have  disappeared 
from  FbX-F1.13,  and  the  tendon  tensions  never  reach  0  tension  state  (-10V).  The 
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igure  4.13  Response  of  flexion  and  extension  tendons 
without  cocontraction  input 


onse  of  flexion  and  extension  tendon 
cocontraction  input 


flexion  and  .(\\-|.('iisioii  bias  setting  wa,s  thus  determined  for  FIJ3.  'I'liis  pioeednre  was 
repeated  lor  I'MJO,  FIJI  and  F1J2.  The  biiis  was  determined  to  be  between  -4  volts 
and  -3.5  volts.  To  maintain  uniformity  and  to  ensure  that  snapping  never  takes  place, 
the  flexion  and  extension  bias  was  set  to  the  maxinnmi  of  these  two  valiu's  i.e.  at 
-3.5  volts  for  all  tlie  joints. 

Once  the  calibration  of  various  gain  blocks  of  the  analog  controller  and  those  of 
tlte  position  and  tendon  tension  sensors  was  carried  out  successfully,  the  modeling  of 
the  various  joints  of  finger  1  and  coupling  between  them  was  performed  as  is  discussed 
in  the  next  chapter. 


V  .  TRANSFER  FUNCTION  IDENTIFICATION 

Tliis  cliapier  describes  the  process  to  identify  the  transfer  functions  of  the  foui- 
joints  ol  finger  I  as  well  as  tliose  of  the  coupling  between  joints  1,  2  and  3. 

5.1  INTRODUCTION 

Tile  servo  loop  for  each  joint  of  tlie  DH  consists  of  tlirce  loops,  two  inner  loops 
and  one  outer  looj),  as  sliown  in  the  block  diagram  of  figure  5.1.  The  two  inner 
loo])s  Jiiaintain  the  flexion  and  extension  tendon  tensions  and  the  outer  loop  controls 
the  position  of  the  joint.  To  identify  the  open-loop  transfer  function  of  each  joint, 
both  the  force  loops  were  closed  and  the  outer  position  loop  was  opened.  To  check 
the  linearity  of  the  output  with  the  changes  in  the  input  amplitude,  sine  waves  of 
Ireciuency  0.5  Hz.  and  of  varying  amplitudes  were  apjdied  to  the  servo  loop  of  F,1.J1 
(finger  1  joint  1)  and  the  outputs  (POS  in  figure  5.1)  were  recorded.  This  test  was 
repeated  using  sine  waves  of  frequency  2  Hz.  The  results  are  shown  in  figures  5.2  and 
5.3  and  the  tabulated  results  are  given  in  Appendix  C.  The  various  gain  block  and 
bias  settings  are  shown  on  top  of  the  plots  in  figures  5.2  and  5.3.  It  can  be  seen  from 
tliese  figures  and  Table  Cl  in  Appendix  C  that 

1.  the  peak-to-peak  voltage  ol  the  output  increa.sed  in  a  nonlinear  fashion  with  the 
increase  in  the  input  peak-to-peak  voltage. 
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nr  (Cocontraction  input) 


Figure  5,1  Block  diagram  of  the  position  control  loop  of  a 

single  joint  showing  the  various  blocks  to  be  calibrated 
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Figure  5.2  Response  of  finger  1  joint  1 

for  a  sine  wave  of  amplitude  1  volt 
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2.  as  tlie  input  voltage  increased,  the  output  was  flexing  more  than  extending 
(figuics  0.2  and  5.3).  J,  his  was  found  to  he  due  to  the  tibscnce  of  j^osition 

COIlll'ol  l()0|). 

One  ot  ilic  leasons  for  tlie  nonlinearities  may  be  the  differences  in  the  dynamics 
of  the  flexion  actuation  package  and  the  extension  actuation  package.  Due  to  the 
above-mentioned  reasons,  it  was  decided  to  close  the  position  loop  when  conducting 
the  lrc(|ucncy  response  tests  for  identifying  the  open-loop  transfer  functions  of  tlie 
various  joints. 


5.2  NOTATION 

Figure  5.1,  a,s  mentioned  above,  shows  the  block  diagram  of  tlie  servo  loop  of  a 
single  joint.  Notations  used  in  the  figure  and  their  explanations  are  as  follows  : 


PD 

POS 


PGO 


EXT 

FLX 


GP 


GV 


GE 


GF 


Position  desired  in  volts  (input  to  the  servo  loop) 
Position  output  of  the  Hall  effect  sensor  in  volts 
(output  of  the  servo  loop) 

Output  of  the  position  gain  block  in  volts 
Output  ol  the  exi.ensor  tendon  tension  sensor  in  volts 
Output  of  the  flexor  tendon  tension  sensor  in  volts 
Gain  setting  of  the  position  gain  block  in  volts 
Gain  setting  of  the  velocity  gain  block  in  volts 
Gain  setting  of  the  extension  gain  block  in  volts 
Gain  setting  of  the  flexion  gain  block  in  volts  ' 


Gxx{s)  ~  Open  loop  transfer  function  of  finger  x 

J xx{s)  -  Closed  loop  transfer  function  of  finger  x  joint  x 

TOxy{s)  -  transfer  function  of  coupling  between  the  outputs  of 
joint  X  and  joint  y  due  to  input  at  joint  x 
'I'xyi’^)  -  transfer  function  of  coupling  between  input  of 

joint  X  and  output  of  joint  y  due  to  input  at  joint  x 
~  input  of  joint  X 
i'x('S)  -  output  of  joint  X 

f'V  "  |)n>portionaI  constant  of  the  I’ll)  conti'ollcr 

A’v  -  differential  constant  of  tlie  PI  1)  controller 

f'/  -  Gain  factor  of  the  differentiator  circuit 

Ki  -  integral  constant  of  the  PID  controller 

5.3  IDENTIFICATION  OF  TRANSFER  FUNCTION  OF 
FINGER  1  JOINT  0 

The  objective  of  this  experiment  is  to  determine  the  transfer  function  of  joint  0  of 
finger  1.  Sinusoidal  inputs  of  different  frec|ucncies  were  applied  to  the  position  servo 
loop  of  finger  1  joint  0  and  the  output  was  measured.  From  this  information,  gain  and 
phase  plots  were  obtained.  Then,  by  fitting  straight  lines  to  the  gain  and  phase  plots, 
the  transfer  function  of  the  system  was  determined.  Tlie  procedure  of  identification 
is  explained  in  more  detail  in  tlie  following  subsections.  The  hand  was  placed  on  the 
back  of  its  palm  as  shown  in  figure  3.3  so  that  the  plane  of  motion  of  FIJO  (finger  1 
joint  0)  was  parallel  to  the  ground.  This  was  done  to  reduce  the  effect  of  gravity  since 
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tlic  gravitational  force  will 


be  constant  throiigliont  the  time  of  operation  of  Fl.JO. 


5.3.1  INITIAL  SETTINGS 

1.  The  gains  of  the  position  gain  block  GP-FIJO,  GP-FIJI,  GP-F1J2,  GP-F1J3 
were  set,  to  one. 

2.  The  gains  of  the  velocity  gain  block  GV-Fl.TO,  GV-FIJI,  GV-F1.)2,  GV-FI.13 
were  set  to  zero.  This  was  clone  becaii.se  the  objective  of  this  e.xperiment  is  l.o 
find  the  model  of  the  joint  without  the  inclusion  of  anj'  control  parameters. 

3.  The  gains  of  tlic  fle.xion  gain  block  GF-Fl.JO,  GF-Fl.Jl,  GF-FU2  and  CF-1-'].J3 
were  set  to  four.  Tins  was  done  to  ensure  that  the  foice  loop  has  considerable 
stiflness,  and  that,  it  will  regulate  the  tendon  tensions. 

4.  The  gains  of  the  extension  block  GE-FIJO,  GE-FIJI,  GE-F1J2  and  GE-F1.J3 
were  scjt  to  four  for  the  same  reasons  as  mentioned  for  the  flexion  gain  block. 

5.  The  flexion  t(Midou  biases  BF-FIJO,  BF-Ff.Fl,  BF-F1.12  and  BF-F1.I3  and  e.x- 
tension  tendon  biases  BE-F1.10,  BE-Fl.Jl,  BE-l''l.I2  and  BE-FJ.J3  were  set  to 
-3.5  volts  as  determined  in  Chapter  4. 


The  paraiueters  ol  FIJI,  F1J2  and  F1J3  can  be  set  to  anj^  value  since  the}'  do 
not  affect  the  response  ol  FIJO.  Two  joints  are  said  to  be  coupled  if  the  movement 
of  one  joint  results  in  the  movement  of  the  other  joint.  There  is  no  coupling  betwcien 
joint  0  and  joints  1,  2  and  3  since  the  axis  of  motion  of  joint  0  is  perpendicular  to 
those  of  joints  1,  2  and  3  (figure  2.6). 


5.3.2  PROCEDURE 


The  posilioii  loop  and  flexion  and  extension  force  loops  were  closed.  .Joints  1,  2 
and  3  were  commanded  to  lull  extension  during  the  entire  experiment.  A  sinusoidal 
voltage  signal  (PD  in  figure  5.1)  was  applied  at  tlie  input  of  the  servo  looj)  of  finger 
1  joint  0  and  the  data  was  recorded  at  the  following  frequencies  : 

0.1  -  3.0  Hz.  increasing  in  steps  of  0.2  Hz. 

3.0  -  7.0  Hz.  increasing  in  steps  of  0.5  Hz. 

7.0  -  30.0  Hz.  increasing  in  steps  of  2  Hz. 

The  following  parameters  namely  position  output  (POS-FIJO),  output  of  the 
position  gain  block  (PGO-FIJO),  output  of  the  flexion  gain  block  (FGO-FLIO),  output 
of  the  extension  gain  block  (EGO-Fl.JO),  flexion  tendon  tension  (FLX-Fl.lO)  and 
extension  tendon  tension  (F/XT-FJ  .10)  (figure  5.1)  were  recorded  for  each  of  the  above 
frequencies.  The  frequency  was  incremented  in  smaller  steps  in  the  low  frequency 
region  because  the  frequency  range  of  interest  for  the  identification  of  the  transfer 
function  of  the  joint  is  0.1  -  7.0  Hz.  The  open  loop  transfer  function  of  the  joint 
can  be  obtained  by  considering  PGO-Fl.JO  (figure  5.1)  as  the  input  and  the  position 
of  the  joint  (POS-FIJO)  as  the  output.  The  gain  of  the  system  was  calculated  by 
dividing  the  magnitude  of  the  output  (POS-FIJO)  by  the  magnitude  of  the  error 
between  position  desired  (PD-Fl.JO)  and  actual  position  (POS-FIJO),  which  is  same 
as  output  of  the  position  gain  block  (PGO-FIJO  in  figure  5.1)  since  the  gain  GP-FIJO 
was  set  to  one.  The  gain  in  cIB  and  the  phase  angle  in  degrees  between  tlie  input 
and  the  output  was  calculated.  Tlie  details  of  the  calculations  are  given  in  the  next 
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section. 

5.3.3  PROGRAM  TO  CALCULATE  GAIN  AND  PHASE 

The  program  to  calculate  the  gciin  in  clB  and  the  phase  in  degrees  is  given  in 
Appendix  D.  The  program  was  written  in  MATRIX^,  which  is  a  powerful  computer- 
aided  design  package.  The  amplitudes  of  the  input  sine  wave  (PGO-FIJO)  and  the 
output  sine  wave  (POS-FIJO)  were  computed  foi-  all  the  above  mentioned  frequencies. 
The  gain  in  dB  was  calculated  using  the  formula 

gai„  =  20Iogf?iliP^')db 

\  input  J 

The  phase  of  the  output  was  calculated  using  the  formula: 

pliase  =  ^  X  360  degrees 

tp 

wliere 

till  -  time  at  which  the  input  sine  wave  (PGO-FJ.JO)  cro.s.ses  the 

reference  line  (0  volts) 

tout.  -  time  at  whicli  the  output  sine  wave  (POS-l'M  JO)  crosses  its 

reference  line 

tp  -  time  ])eriod  of  the  sine  wave  whicli  is 

obtained  bj^  calculating  1/frequency  (Hz.) 

The  gain  (in  dB)  and  phase  (in  degrees)  was  tabulated  and  plotted  agevinst  the 
trequenc}^  ot  oscillation  cu  in  radians/sec.  Using  straight  line  apjjroximations  (Bode 
plot)  on  the  gain  and  phase  plots,  the  transfer  function  of  the  joint  was  determined. 


(5.1) 


(5.2) 
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ilie  transler  lunction  is  of  second  order.  Since  there  was  a  steady-state  error  foi‘  a 
step  input,  tlie  type  of  the  system  was  identified  as  0.  The  general  form  of  tlie  transfer 


function  is  given  b}' 

+  2(<x)nS  + 

Closing  the  position  servo  loop  with  a  unity  feedback,  the  closed-loop  transfer 
function  is  obtained  which  is  given  by 


R{s)  s2  +  2Ce/W„c/.S  + 


wliere 


The  gain  and  phase  was  calculated  for  sinusoidal  inputs  of  2V,  5V  and  8V.  Figui  e  5.4 
sliows  the  gain-phase  plot  of  FIJO  for  sinusoidal  inputs  of  amplitudes  2V,  5V  and  8V. 
In  all  tlie  (liiee  cases,  the  roll-off  started  pretty  imich  at  the  same  freciuency.  The  only 
difference  was  in  the  gain  of  the  system  K.  K  increased  with  increase  in  amplitude 
(figure  5.4).  It  can  be  seen  from  equation  (  5.5)  that  Cc/  is  inverselic  pi-oj>ortional 
to  K.  Thus,  with  increase  in  amplitude,  Q  decreases  which  makes  the  system  more 
underdamped.  Hence,  it  was  decided  to  desigri  the  controller  for  the  8V  sine  wave. 
This  miglit  result  in  making  the  system  which  is  critically  damped  for  8V,  slightly 
overdamped  loi'  inputs  ol  lesser  amplitude.  But  an  overdamped  system  is  preferred 
to  an  underdamped  system. 

figure  5.5  sliows  the  ga.in-))hase  ])lot  of  Fl.JO  for  sinusoidal  inputs  of  amplitude 
8V.  It  can  be  seen  from  the  figure  that  the  phase  plot  starts  at  -56.16  degrees.  Initiall,y, 
it  was  tliought  to  be  a  constant  phase  sliift  which  translates  to  a  variable  delay  in  tlie 
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Figure  5.4  Gain  and  phase  plots  of  finger  1  joint  0 
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time  domain.  However,  after  additional  experimentation,  it  was  found  that  when  the 
position  gain  K,,  was  increased,  the  initial  phase  shift  disappeared.  This  can  be  seen 
from  figures  5.0  and  5.7.  Thus,  the  initial  phase  shift  can  be  ignored,  since  K,,  was 
designed  to  have  a  high  value  (  design  discussed  in  section  5.4).  The  transfei’  function 
ol  joint  0  was  d(;terinined  to  be  given  below: 


G^oo("S)  = 


9533.25 
+2405  +  3600 


(5.6) 


Figure  5.8  shows  the  gain-phase  plot  of  FIJO  as  well  as  that  of  the  estimated 


model . 


The  procedure  for  identification  of  the  plant  using  sinusoidal  inputs  of  2V,  5V  and 
8V  was  repeated  lor  joints  1,  2  and  3  of  finger  1.  'Fhe  only  diirerence  is  that  there  is 
coupling  between  joints  1,  2  and  3  .  The  coupling  exists  between  a  particular  joint 
and  joints  distal  to  it  only  i.e.  joint  2  moves  when  joint  1  is  commanded  to  move,  due 
to  coupling  but  joint  1  does  not  move  wlien  joint  2  is  commanded  to  move.  Hence, 
when  the  joint  under  consideration  was  commanded  to  move,  the  tendons  of  all  distal 
joints  were  disconnected.  .Joints  1,  2  and  3  were  initially  determined  to  be  of  second 
ordei',  with  a,  general  transfer  function  as  follows  : 


G{s)  = 


+  2Cu)nS  +  LOI 


KuP' 

_ ^  _ 

(s+Pi)(5  +  P2) 


wlierc  />|,P2  arc  the  poles  of  G(s). 


However,  the  step  rc.sj)onses  of  the  joints  1,  2  and  3  were  highly  oscillatory  and 


w'ere  tending  l,o  remain  so  when  the  position  error  gain  GP  w'as  increased  (.Ajjpendix 
C).  This  could  not  liappen  if  the  joints  w'ere  of  second  order.  Hence,  the  transfer 
functions  of  joints  1,  2  and  3  were  determined  to  be  of  third  order.  The  transfer 
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frequency  (r.dUns/.eco„d) 


gain  plot  obtained  from  experimental  data 
phase  plot  obtained  from  experimental  data 
gain  and  phase  plots  of  the  estimated  model 


Figure  6.8  Gain  and  phase  plots  of  finger  1  joint  0 
and  its  estimated  model 


functions  of  joints  1,2  and  3  are  as  follows  : 

Finger  1  Joint  1 

Q  _  ()J  08730 _ 

+  2'15.s  -(-  3Jr)0)(,s  -f  000) 

Finger  1  Joint  2 

r-  f  \  2986605 

^■^22  ('5)  =  -T-r — - - - - - - 

(^2  +  90^  +  5625)(s  +  300) 

Finger  J  Joint  3 
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(5.8) 


(5.9) 


G'33(.s)  = 


14230352 


(.^2  +  340c!  +  22500)(.s  +  800)  (5.10) 

The  gain-phase  plots  and  tables  of  joints  1,  2  and  3  of  finger  1  and  of  their 
estimated  models  are  given  in  Appendi.x  C. 


5.4  DESIGN  OF  INDIVIDUAL  JOINT  LOOPS 

hrom  e(|iiatioii(  5.6),  it  can  be  seen  that  joint  0  is  a  second  order  sysi.em.  .loints 
1,  2  and  3  (equationsf  5.8),  (  5.9)  and  (  5.10)  )  are  determined  to  be  third  order 
•systems  witl.  two  quadratic  poles  and  a  simple  pole.  Since  the  simple  pole  is  far  away 
111  the  left  hall  ]>lane,  it  can  be  ignored  while  carrying  out  the  design  steps.  Hence, 

a.ll  the  lour  joints  can  be  modelled  as  second  order  systems  with’  transfer  functions  of 
l^lie  form 


(5.11) 


where  cj„  is  the  natural  frequency  and  (  is  the  clamping  ratio  of  tlie  system. 

Figure  5.9  shows  the  block  diagram  of  the  PD  (])roportional  plus  derivative) 
control  loo|3  ol  an  individual  joint.  The  closed  loo]i  transfer  function  of  Pigure  5.9  can 
be  written  as 


Cci  =  2Cujn  +  Kh'„Kj 
^'nci  =  ( 1  +  K  Kj., ) 


(5.13) 

(5.14) 


Since  the  open  loop  transfer  functions  of  the  joints  eciua.tion(  5.11)  are  of  tj'pe 

zero,  there  will  be  a  steady-state  error  to  a  step  input  (figure  5.10).  The  steady-state 
error  is  given  by  ‘ 

where  R,  is  tlie  amplitude  of  the  step  input 

Since  the  steady-state  error  is  inversely  proportional  to  Kj„  the  error  can  be 
reduced  by  clioosing  a  high  value  of  Kp.  However,  tlie  highest  value  of  Kp  tliat 
can  be  chosen  using  the  analog  controller  is  10,  so  Kp  was  set  to  S.  An  overshoot 
is  undesiral)lc,  lienee  tlie  closed  loop  transfer  function  is  to  be  designed  to  have  a 
damping  ratio  (Q)  of  1.  Substituting  Kp  -  8  and  (cl  =  1  in  equations  (  5.12),  (  5.13) 
and  (  5.14),  the  value  of  was  calculated.  The  design  parameters  for  tlie  various 
joints  of  finger  1  are  given  in  table  5.1 


Table  5.1  Design  Parameters 


Joint 

Kp 

Ky 

Joint  0 

8 

4.2 

Joint  1 

8 

4.] 

Joint  2 

8 

6.1 

Joint  3 

8 

3.2 

5.5  INTEGRAL  CONTROL 

Figure  5.10  shows  the  step  responses  of  finger  I  joint  0  for  designed  values  of  h), 
and  Ky  and  lor  hp  —  1  and  I\y  =  0.  It  can  be  seen  that  the  step  responsof  for  the 
tiesigned  values  ol  Kp  and  Ky  has  an  improved  rise  time  and  also  the  steadj^-state 
error  is  considerabl}'  less  a,s  compared  to  tlic  stej)  response  for  Kp  =  1.  Uowevei-,  tlierc 
is  still  a  small  stea.dj^-state  error.  This  is  because  joint  0  is  a  t3'^pe  zero  S3\stcm.  ff  the 
lype  ol  the  s.ys(,em  is  increased  bj^  one,  (,hc  steady-state  enor  will  be  reduced  to  zero 
lor  unit  ste|)  input[6].  This  can  be  adiieved  by  adding  an  integral  term  to  the  PD 
controller,  thus  making  it  a  PID  (proportional  plus  integral  plus  derivative)  controller 
(figure  5.11).  The  effect  of  the  integral  term  can  be  seen  from  figure  5.12  where  the 
steady-sta.te  eri-or  is  reduced  to  zero  for  Ki  =  2  .  Tire  effect  can  be  seen  more  clearly 
from  figures  CS  and  C9  in  Appendix  C.  The  integral  term  was  implemented  using- 
software.  A  program  was  written  in  C  for  the  integral  term  to  be  introduced  in  the 
analog  controller.  The  program  is  given  in  Appendix  E.  Another  way  of  reducing  the 
stead}''-state  error  is  by  introducing  a  gain  external  to  the  position  servo  loop  of  an 
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.2 


.25 


.3 


.35 


Step  input 

step  response  for  A'p  =  1,  =  0 

Jtep  response  for  Kj,  =  8,  =  4.1 


step  response  with  =  8,  =  4.1  and  Ki 


* 


Figure  5.12 


Step  response  of  finger  1  joint  1 
with  the  addition  of  Kj 


indivulMal  joint,  (figure  5.13).  The  gain  Kg  is  obtained  using  the  formula  given  below  : 


R 

Tl, 


The  gain  Kg  for  finger  1  joint  1  was  determined  to  be  1.1.  The  step  response  of 
finger  1  joint  1  after  the  introduction  of  Kg  is  shown  in  figure  5.14.  It  can  be  seen 


that  tliere  is  no  steadj'^-state  error. 


5.6  IDENTIFICATION  OF  JOINT  COUPLING 

1  wo  joints  are  coupled  if  tlie  motion  of  one  joint  affects  tlie  motion  of  the  other, 
).e.  wlien  joint  1  is  moved,  if  joint  2  moves  then  joints  1  and  2  arc  coupled. 

Ciiven  below  is  a,  descri|;)tion  oi  the  nature  ol  coii|)ling  between  joints. 


I.  'I'licre  is  no  coupling  between  joint  0  and  the  other  tliree  joints  in  the  finger. 
This  is  because  the  axis  of  motion  of  joint  0  is  ]>erpendicular  to  thos('  of  joints 
1,  2  and  3. 


2.  Amojig  the  coupled  joints  (joints  1,  2  and  3),  there  is  a  significant  coupling 
between  the  joint  in  consideration  and  the  joints  distal  to  it  only  . 


The  coupling  between  the  various  joints  is  showui  in  table  5.2. 


.s 


2 


2.5 


3 


3.5 


step  input 

step  response  with  =  6,  =  4.1  and  Kg  =  1 


Figure  5.14  Step  response  of  finger  1  joint  1 
with  the  addition  of  Kg 


-lablc  0.2  Nature  of  coupling  between  joints  1,  2  and  3 


Joint  at  which  the  input  is  applied 

Coupled  joints 

Non-coupled  joints 

Joint  0 

None 

Joints  1,2&3 

Joint  1 

Joint2,  Joints 

Joint  0 

Joint  2 

Joint  3 

Jointl,Join  tO 

Joint  3 

None 

JoiiitO, Joint  l,.Joiiit2 

0.,<;  ol  11,0  for  tlic  coupling  belwcc,  diffecnt  joints  may  bo  duo  to  tho 

lact  that  tlic  tendons  of  dilTerent  joints  are  routed  over  pulleys  mounted  on  the  same 
sliaft.  For  example,  tbo  tendons  of  joints  2  and  3  are  routed  over  pulleys  rnouuterl  or, 
tlie  same  slialt  as  the  pulleys  tliat  carry  tlic  tendons  of  joint  I .  Tliis  may  jnslify  tbe 
existence  of  significant  coupling  between  1.1, e  joint  in  consi<le,-atio„  and  distal  joints 
only,  tl.us  wbeu  joint  1  moves,  the  flexor  and  extensor  tendons  of  joints  2  and  3  also 
move,  wind,  results  in  the  movement  of  joints  2  and  3.  A  further  reason  for  the 
cxi,s(,oik:o  of  (,l,o  coupling  nia.y  be  clue  l,o  inertial  loading. 

Jmtially,  it  was  not  certain  whether  the  conpling  is  between  the  input  of  the  joint 
«>.mnan<led  to  niovo  anri  the  output  of  the  eouplerl  joint  (iuputmutput  coupling) 
(figur  e  5.15)  or  between  the  outputs  of  the  joint  commanded  to  move  and  the  coupled 
Joint  (output-output  coupling)  (figure  5.16)  .  After  conducting  a  few  lest  runs,  it  was 

<o..clude,l  that  the  latter  is  true.  The  rea.sons  for  . . .  this  conclusion  are  as 

follows  : 


1.  iMgures  5.17  and  5.18  show  plots  of  step  inputs  applied  to  joint  2  (PD-F1J2) 


Figure  5.18  Step  response  of  F1J2  and  F1J3  illustrating 
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and  (,l.c  step  responses  of  joints  2  and  3  (POS-F1J2  and  POS-Fi  J3)  for  a.  gain 
GP  of  0.3  and  gain  GP  of  8  respectively.  It  can  be  seen  from  figure  5.17  that  the 
resijonse  ol  joint  2  settled  down  to  a  steady-state  value  and  so  did  the  response 
of  joint  .3.  However,  in  figure  5.18,  tlie  step  response  of  joint  2  wa,s  oscillatory 
whidi  resulted  in  joint  3  being  oscillatory  too.  From  tliese  two  figures,  it  can 
be  concluded  that  the  output  of  joint  3  (coupled  joint)  depends  on  the  output 
of  joint  2  (joint  commanded  to  move). 

2.  The  gain  and  phase  plots  of  input-output  coupling  (T^Js)  in  figure  5.16)  changed 
vvitl,  the  change  in  control  pa.rameters  (K,  and  /<„  in  figure  5.9)  of  the  closed 
loo|)  control  of  joint  x.  This  implies  that  the  coupling  term  depends  upon 

the  output  of  joint  X,  which  confirms  the  above  conclu.sion. 

5.7  COUPLING  TRANSFER  FUNCTIONS 

1  he  transler  lunctions  of  coupling  between  joints  were  obtained  using  the  fre¬ 
quency  response  analysis.  The  position  and  force  loops  of  all  the  joints  were  closed. 
Given  below  is  the  iirocedure  for  the  identincation  of  coupling  between  joints  I  and 
2  due  to  an  input  at  joint  1.  Sinusoiilal  inputs  of  ainplitndi-  8V  were  a|)pli<’d  at  th<' 
input  of  the  servo  loop  of  joint  1  (PD  in  ngure  5.1)  lor  the  following  fre(|uencies  : 

0. 1-3.0  Hz.  increasing  in  steps  of  0.2  Hz. 

3. 0-7.0  Hz.  increasing  in  steps  of  0.5  Hz. 

7.0-30.0  Hz.  increasing  in  steps  of  2  Hz. 

The  position  outputs  of  joints  1,  2  and  3  (POS-Fl.H,  POS-F1.J2  and  POS-F1.J3) 
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were  recordcxl.  A  j^rogram  was  writien  in  MATRIX,  to  calcnlale  tlie  gain  and  phase 
with  POS-Fl.Ii  as  input  and  POS-F1J2  a.s  ontpnt.  Tl.is  way,  the  transfer  function  of 
coupling  between  the  output  of  joint  1  and  output  of  joint  2  (output-outi>ut  coupling) 
ca.n  be  determined.  This  jMogram  wa.s  written  in  a.  similar  manner  as  the  pi-ogram 
written  to  ideiitily  the  transfer  functions  of  individual  joints  .  The  frequencies  were 
increased  in  smaller  steps  in  the  lower  frequency  region,  because  the  frequency  range 
of  interest  lor  identification  of  the  transfer  functions  of  coupling  between  various  joints 
is  0.1  -  7.0  llz.  However,  the  data  was  collected  for  fre(|uencies  upto  30  hertz  since 
l.he  bandwidth  o(  each  joint  was  deU'rmiiied  to  be  in  the  range  between  15  and  20 
liertz.  1  lie  program  to  calculate  the  gain  and  pliase  is  given  in  Appendi.x  D.  The  gain 
and  |)hase  were  plotted  against  frequency  a;  (radians/sccond).  The  transfer  function 
ol  the  coupling  was  obtained  by  using  straight-line  approximations  on  the  frequency 
lesponse  plot,.  I  lie  l.ransler  (unction  7’0|2  is  given  by 

7Y)  -j-  900  i  7  18 

52  +  965  +  3600  "”  5  +  4S± j36 


In  the  same  manner,  the  coupling  between  joints  1  and  3  (TOja),  and  joints  2 
and  3  (7^0.23)  were  identified.  These  coupling  transfer  functions  are  given  by 


TO,,{s)  =  - 


643.383 


643.83 


>2  +  18s  -f  8100  s  -b  9  ±  i89.5. 


__  0-9o76  (.s^  -f  70.s  -I-  2500)  _  ^0.9576  (.s  +  35  ±  j35.707) 


-f  11 9s  +  7225 


s  +  59.5  ±  ,/60.702 


GAIN  (dB)  PHASE  (degrees) 


Ik  »;B|i 


frequency  (radians/second) 


gain  plot  obtained  from  experimental  data 
phase  plot  obtained  from  experimental  data 
gain  and  phase  plots  of  the  estimated  model 


Figure  5.19  Gain  and  phase  plots  of  output-output  coupli 
between  joints  1  and  2  and  those  of  their  estimated  model 


gain  CdB)  PHASE  (degrees) 


0 


gain  plot  obtained  from  experimental  data 

phase  plot  obtained  from  experimental  data 
^ain  and  phase  plots  of  the  estimated  model 
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I].e  gain-pljasc  plots  of  the  original  data  of  coupling  between  joints  1  and  2  and 
those  of  the  transfer  function  TOn{s)  are  shown  in  figures  5.19.  The  gain  and  phase 
plots  of  the  other  coupling  transfer  functions  are  given  in  Appendix  C.  It  can  be  seen 
Iron,  these  figures  I, hat  the  fit  is  not  very  good  for  tlie  high  frequency  region.  Tliis  was 
ignotcd,  bcca.nse  tlie  frequency  range  of  interest  is  upto  a  ma.ximum  of  .30  radians/sec. 
There  is  an  initial  shift  of -ISO  degrees  in  all  the  coupling  transfer  functions.  This 
was  accounted  for  by  introducing  a  negative  sign  in  the  transfer  functions. 


5.8  COMPARISON 


The  gam  and  pliase  plots  of  input-output  coupling  (7;,  in  figure  5.17)  were  ob¬ 
tained  lollowing  the  procedure  given  in  tlie  previous  section.  was  set  to  0.3  and  K, 
was  set  to  0.  The  output-output  coupling  term  (7’0..,  in  figure  5.16)  was  multiplied 
with  the  the  closed  loop  transfer  function  of  joint  x  (7;,,  in  figure  5.16)  to  obtain  the 
coupling  transfer  function  between  input  of  joint  x  and  outiiut  of  joint  y.  The  closed- 
loop  transfer  lunction  was  obtained  using  the  same  values  of  control  parameters  as 
given  above.  The  gain  and  phase  plots  of  this  transfer  function  was  com]iared  with 
the  gain  and  phase  plots  of  input-output  coupling  obtained  experimentally.  Figure 
5.20  sl.ows  tlie  gain  and  phase  plots  of  input-output  coupling  between  joints  1  and 
2  and  of  (, heir  estimated  model.  The  gain  and  phase  plots  of  input-output  coupling 
between  the  other  joints  are  given  in  Appendix  C.  It  can  be  seen  that  the  plots  match 
closely.  This  comparison  strengthens  the  validity  of  output-output  coupling  transfer 

functions  that  were  identified  experimentalljc 
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Aaer  obtaining  the  transfer  functions  of  coupling  between  different  joints,  an  al- 

goritlim  to  decouple  different  joints  of  finger  1  of  the  DH  was  carried  out  as  discussed 
in  the  next  chapter. 


VI  .  DECOUPLING  ALGORITHM 

In  tins  cliii.|)(,cr,  an  alogithm  to  decouple  dinerent  joints  of  finger  1  is  discussed. 
Notations  used  in  tliis  cliajd  er  have  the  same  explanations  as  those  given  in  Chapter  5. 

6.1  DECOUPLING  ALGORITHM 

the  traiisler  lunctions  of  individual  joints  of  finger  1  and  those  of  the  outjiut- 
output  coupling  behveen  different  Joints  (figure  5.10)  were  identified  in  the  previous 
chapter.  Tlie  coupling  between  the  input  of  joint  x  and  the  output  of  joint  y  (2;.,J 
is  obtained  by  multiplying  the  closed-loop  tra.nsfer  function  of  joint  x  (T,,  in  figure 
5.15)  with  tlie  transfer  function  of  the  output-output  coupling  between  joint  x  and 
joint  y  (TO,,,  in  figure  5.15)  as  shown  in  figure  5.16.  The  coupling  between  joints  x 

and  y  (1.,,)  can  be  removed  by  adding  to  the  input  of  joint  v,  the  term  T~'T.  as 
shown  in  fig  me  0.1. 

The  system  shown  in  figures  5.15,  5.16  and  6.1  can  be  represented  as 

yi(^)  ^  Tu{s)  X:is)  (C.i) 

y2{-^)  =  T;2(s)X,{s)  +  TOu{s)X,{s)  (6.2) 

Substituting  equation  (6.1)  in  equation  (  6.2),  we  get 

Y^is)  =  T22is)  X2{s)  +  Tn{s)  Xr{s)  (6..3) 
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where 

'J^s)  =  Txt{s)rOi2{s) 

II.  can  be  seen  from  eciuation(  6.2)  tliat  the  outjnit  ofjoi.it  2,  F2(6’),  i.s  dependent 
upon  the  in]M.t  to  joints  1  and  2,  X^{s)  and  A'2(5),  respectively.  To  reniove  the 
coupling  between  joint  1  and  joint  2,  i.e.  tl.e  dcpendancy  of  on  A-,(s),  tlie 

.system  can  be  modified  by  changing  the  input  function  of  joint  2.  Tliis  can  be  done 


by  subtracting  T22’(^')  ri2(s)  AT(5)  from  the  input  function,  A'2(s),  of  joint  2.  This 
makes  the  output  y2(s)  independent  of  Ad(s)  and  can  be  repre.sented  as 


=  luis)  Ai(s)  +  T22(s)  {A^2(^^)  -  7\2(s)X\{s)]  (C.4) 


Altei’  cancellation,  the  equation  becomes 


=  T22(s).Y2(.^) 


(6..5) 


Joint  :i  is  dccou|)led  from  the  other  joints  in  a  similar  fashion.  The  input  of  joint 

.3  was  modified  to  remove  coupling  between  joint  3  and  other  joints.  The  decoupling 
()(|nM.lioMs  ()l  joinl,  arc^  giv(.'M  by 


=  r„(s)ro„Mx,{s)  +  +  TMX4.f}  (cws) 

nl*)  =  1^13(^)Ai(^)  +  T23(s)X2(s)  +  T33(s)X3(s)  (6.7) 


wliere 


=  Tn(3)TOt3(3) 

T23(3}  =  7.22(3)7023(3) 

^3(3)  =  Ti3(s)Xi(s)  +  r23(s)X2(5)  + 


(6.8) 

(6.9) 


233(5){X3(5)  -  2r3'(^)r,3(5)A^l(5)  -  23~3'(5)r23(5)A^2(.,)}  (6.10) 


-  3’33(s)A'3(5) 


(0.11) 


6.2  REDUCED-ORDER  DECOUPLING  SCHEME 

The  desed-loop  tran.3re,.  functions  of  individual  joints  (T,,  in  figure  C.l)  were  de¬ 
rived  from  their  respective  open-loop  transfer  functions,  using  the  design  parameters 
given  Tahle  5.1.  The  coupling  terms  {r„  in  figure  6.1)  and  the  decoupling  terms 

i'l  lignmfi.l)  were  calculated.  The  decoupling  terms  rest, ltd  in  fourth  order 

C(|  11  all  ions  vvliicli  a.rc  given  below 

^n'is)7Hs)  =  _  (1-0829)  {s  +  24  ±  jlS)  (s  +  268.76)  (s  +  317.26) 

(5 +  48  ±y36)  (s -f  278.46)  (5 -f  .322.12)  (6-12) 

It  can  be  .scon  from  equation  (  6.12)  that,  the  zeros  -268.76  and  -317.26  aud  polos 
278.46  and  -322.12  are  lar  away  from  the  ima.ginary  axis  in  the  left  half  plane  when 
compared  to  tlie  quadratic  zeros  and  poles  respectively.  Their  effect  is  negligible  and 
lienee  can  he  ignored.  Also,  they  do  not  contribute  to  the  IVccjueucy  rcjionse  plot 
in  the  frequency  range  of  interest  (0.1  -  7.0  hertz).  It  is  also  evident  from  equation 
(  6.12)  tliat  the  simple  poles  and  zeros  are  very  close  to  each  other  and  hence  can  be 
cancelled.  l+,uation(  6.12)  is  thus  reduced  to  a  second-order  transfer  function  given 

by 

=  (-1.0297) 

{s  +  iS±j36) 

Note  tliat  the  reduced-order  transfer  function  is  same  as  the  output-out|H.t  cou¬ 
pling  transicr  lunction  TO^  (equation  5.17)  except  for  a  gain  factor  and  that  all  the 
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Figure  6.2 


Comparison  of  gain  and  phase  plots  of  decoupl 
terms  with  their  reduced-order  models 
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gain  and  phase  plots  of  coupling  transfer  functions  between 
the  outputs.of  joints  2  and  3 


Figure  6.4  Comparison  of  gain  and  phase  plots  of  decoupling 
terms  with  their  reduced-order  models 


discarded  .c  os  and  poles  arc  the  poles  of  t],=  closed  loop  traosfer  fenctious  of  joints 

I  and  2  .  I  Ins  is  because  joints  1  and  2  have  high  bandwidths,  which  are  increased 
r..rU,cr  by  c.lioosing  a  high  value  of  (equation  5J^). 

In  the  same  way,  the  decoupling  terms  rs'r.s  and  are  reduced  to  socond- 

Oi'der  transfer  rnnetions  which  are  same  as  TO,,  („|Uatiou  5.1 7)  and  TO-,,  (e.|uatiou 
5.18)  respectively  e.xcept  for  a  gain  factor.  Tlie  decoupling  terms  and  T^T,, 

and  tlieir  reduced  versions  are  given  below 

7'a  =  _  _  (389.95)  (.s  +  390.48)  {s  +  422.05381 

(5  +  9  ±  i89.5)  (s  +  278.47)  (s  +  322  ]  2) 

=  (-1.113) -Ji3-383  ^ 

5  +  9±j89.5  (6.I0) 

7"33n-!^-)72;i(.s)  =  (1  ng]  p)  (:9576)(.s  +  35  ±  i:35.707)(,s  +  390.48)(.$  +  422.0.538)  . 

(5  +  59.5  ±  i60.7)  f,s  4-  26S.7fii  be  -i-  ;■{  1 7  07^  ^0 


(5  +  59.5  ±  jC)Q.7)  (.s  +  268.76)  (5  +  .317  07) 
(s  +  35  ±  ,3.5.707) 

(cs  +  59.5±i60.702) 


(6.17) 


To  check  the  validity  of  the  reduced-order  model,  a  compari.son  of  the  gain  and 
pha.,e  plots  of  :/’-7c  and  TO,,  (figure  6.2).  the  gain  and  phase  plots  of  Ti,'T„ 
and  TO,:,  (figure  6.3)  and  those  of  JS'Jis  and  TO-,-,  (figure  6.4)  was  perforruerl.  It 
can  be  scrii  that  the  gain  and  pha.se  plots  match  very  well.  Dlirereuce  equations  for 
Ihc  decoupling  terms  were  computed  and  a  C  cotie  wa,  written  to  implement  the 
difference  equations  (given  in  Appendix  E). 


6.3  SIMULATION 


1  he  simulation  of  the  different  joints  of  finger  1  and  the  decotipling  algorithm  was 
ixn-ronnetl  using  .SY.STEM.nUILD  in  MATRIX,,  a  powerful  computer  aide.l  desim 


package. 
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6.3.1  MATRIXx 

MATRIX,  is  a  powerful  programmable,  matrix  calculator  with  excellent  graphical 
capabilities.  With  this,  it  is  possible  to  solve  complex,  large-scale  matrix  problems. 

6.3.2  SYSTEM_BUILD 

SYSTEM.BUILD  is  a  ulilily  of  MATRIX^  wliid,  provides  a„  intoractivc,  „,em,. 
driven  graphical  environnronl  for  building,  modifying  and  editing  complex  computer 
simidation  models.  Simulating  sytem  performance  under  both  nominal  and  stniincd 
environment  is  easily  accomplished  with  SYSTEM.BUILD.  SYSTEM.BUJLD  also 

provides  rnorhilarity  in  design  which  makes  testing.  nuKlifying  and  iiiterfacing  parts 
oJ  a  model,  a  simple  task. 


6.3.3  BASIC  BUILDING  UNIT  -  A  BLOCK 

SYS  IEMJIUILD  basic  building  unit  is  the  block.  SYSTEM.BUILD  has  a  lar^ 
library  of  diflerent  types  of  blocks.  The  main  block  categories  are 

1.  iSUI’ElvMJIsOCK 

2.  GAIN  BLOCK 

3.  PIEC'E-WLSE  LINEAR  FUNCTIONS 

4.  DYNAMIC  BLOCKS 


5.  TRIGONOMETRIC  FUNCTIONS 


6.  USER  CODE  BLOCKS 

7.  COORDINATE  TRANSFORMATIONS 

8.  SIGNAL  SOURCES 

9.  LOGICAL  FUNCTIONS 

10.  ALGEBRAIC  EQUATIONS 

11.  P  0  VV  E  R  -  EX  I  ’  0  N  EN T I A  L -  L  0  G  A  RI T 11 M 

Figure  6. .5  slio\v.s  the  general  architecture  of  a  block. 

Wlicn  using  SySTEM_BUILD,  the  system  prompts  tl.e  user  for  the  type  of  block, 
block  iifimc,  iiiiinber  of  inputs,  number  of  outputs,  number  of  states  and  block  pa¬ 
rameters.  The  neat  step  is  to  determine  the  simulation  time  duration  and  the  input 
lorcing  functions.  Once  that  has  been  done,  the  motlel  is  ready  to  run. 

6.3.4  SUPER-BLOCK 

A  very  important  type  of  block  is  SUPER-BLOCK.  This  block  can  have  uplo 
one  hundred  otlier  blocks  interfaced  in  any  way.  The  most  important  advantage  of 
a  SUPER-IILOCK  is  that  it  can  contain  other  SUPER-BLOCKS.  This  permits  the 
nesting  of  SUPER-BLOCKS  as  seen  in  figure  6.6.  This  nesting  property  makes  it 
po.ssiblc  to  mijilcmcnt  complex  systems  which  contain  any  number  of  blocks. 
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Figure  6.6  Nesting  of  super-blocks 


6.4 


SIMULATION  OP  THE  DECOUPLING  ALGORITHM 

The  decoupling  algorithm  as  explained  in  section  6.2  was  implemented  as  shown 
in  figure  6.7,  Blockl.  Block2,  BlocIO  and  Blocltd  are  implemented  as  super-hlocks  in 
MATB  IX..  T„  shown  in  figure  6.1,  represents  the  closerl  loop  control  of  joint  x  and 
i»  implementerl  as  a  super-block  Txx.  Figure  6.8  represents  the  sirvo  loop  of  joint 
X  (J„)  with  the  fccdhack  controller  and  the  scries  controller,  which  is  collectively 
called  the  PID  controller.  Blockl  simulates  the  closexi  loop  control  of  joint  1.  I„„ck2 
represents  the  simulation  of  joint  2  and  that  of  coupling  of  other  joints  with  joint 
2.  Block:)  and  Blockd  simulate  the  closed  loop  control  of  joint  3  and  the  coupling 
between  joint  3  and  joints  1  and  2.  The  four  super-hlocks  Blockl,  Block2,  Blocks  and 
Blockl  are  incorporated  in  another  super-block  named  DEC  (sliown  in  Hgure  6.7). 
Super-Block  DEC  reproienls  the  entire  system  (joints  1,  2  and  3  of  finger  1).  The 

block  diagiams  which  represent  the  system  as  iiriplcmciited  in  MATR.I.X,,  is  given  in 
Appendix  G. 


6.5  SIMULATION  RESULTS 

To  illustrate  the  coupling  between  joints  1,  2  and  3  of  finger  1,  the  system  shown 
ill  figure  5.1.5  wa,  simulated  in  MATRIX.,  (as  explained  in  scetion  6.4).  A  sinusoidal 
signal  was  applicxi  to  the  input  of  joint  1  (A',(s)  in  figure  5.15)  and  tlie  responses  of 
.ioints  1,  2  and  3  were  recorded  and  plotted  (figure  6.9).  It  can  be  seen  from  figure  6.9 
that  the  outputs  of  joints  2  and  3  are  affected  due  to  the  input  at  joint  1.  Similarly, 
figure  6.10  illustrates  the  coupling  between  joints  2  and  3  due  to  input  at  joint  2. 


^l(3) 


118  • 


Figure  0.7  Block  diagram  of  the  decoupling  algorithm 
showing  the  different  super-blocks 


TIME  (seconds) 


xxxx 
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sinusoidal  input  of  joint  2 
response  of  joint  1 
response  of  joint  2 
response  of  joint  3 


Figure  6.10  Response  of  joints  1,  2  and  3  for  an  input  at  joint  2 
without  the  decoupling  scheme 
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sinusoidal  input  of  joint  3 
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Figure  6.11 


Response  of  joints  1,  2  and  3  for  an  input  at  j 
without  the  decoupling  scheme 
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Figure  6.12 


Response  of  joints  1,  2  and  3  for 
with  the  decoupling  scheme 


an  input  at  joint  1 
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sinusoidal  input  of  joint  3 
response  of  joint  1 
response  of  joint  2 
response  of  joint  3 


Figure  6.14  Response  of  joints  1,  2  and  3  for  an  input  at  joint  1 
with  the  decoupling  scheme 


llic  responses  ol  joints  1,  2  and  3  due  to  ca  sinusoidal  input  at  joint  3  is  sliown  in  figure 
Ci.ll.  It  ean  be  seen  from  ngure  6.10  that  there  is  no  response  at  joint  1,  similarly  in 
figure  6. 1 1 ,  th<-  respon.ses  of  joints  1  and  2  are  zc'io.  'I’his  is  because  the  coujiling  exists 
between  a  joint  commanded  to  move  and  the  distal  joints  only,  there  is  no  coupling 
between  a  joint  at  which  the  input  is  applied  and  a  proximal  joint  (Table  5.2).  The 
decoupling  sclieme  (figure  6.1)  was  simulated,  the  results  of  which  are  shown  in  figures 
6.12  -  6.14.  It  can  be  seen  that  the  coupling  has  been  removed  completely.  When  an 
input  was  applied  to  joint  x,  there  was  output  at  joint  x  only,  the  respon.se  of  other 
joints  weic  zevo.  Note  that  figures  6.12  -  6.14  show  tlie  respon.se  of  joints  1,  2  and  3 
with  the  addition  of  Kg  (figure  5.13). 

Thus  the  simulation  of  the  decoupling  algorithm  was  performed  successfully.  The 
conclusion  ol  tins  report  is  given  in  the  next  chapter. 


VII  .  SUMMARY  AND  CONCLUSION 


Tl.c  goal  or  I, lie  Robotic  TelejM-escnce  (R,/T)  prog, -a.,,  at  tl,c  irai-.y  G.  .A,„i,stro„g 
Aerospacoi  Medical  Research  Laboratory  (AAMRL)  at  WPAFB  is  to  develop  a  series 
ol  dynamic  telepresence  test  cells  integrating  state-of-the-art  components  such  as  vi¬ 
sual  displays,  seusoi-s  and  robotic  manipulators.  One  of  the  objectives  of  the  R/'l’ 
jn-ogram  is  to  effectively  slave  the  Utah/M. l.T.  Dex'trous  Hand  (DH)  to  an  exoskcle- 
ton  master  worn  by  a  human  operator.  This  would  enable  the  DH  to  be  put  to  use  in 
hazardous  environments  or  deep-sea  or  space  apjilications,  being  driven  remotely  by 
a  human  operator.  Each  joint  of  the  human  hand  is  umpped  to  that  of  the  DH  using 
master/slave  transformations.  .Joints  1,  2  and  3  of  tlie  DH  arc  coupled,  do  enable 
the  cont,-ol  of  each  joint  of  the  DH  sejiarately  by  the  exoskelcton  master,  the  joints 


need  to  be  decoupled. 


I  he  objective  ol  this  thesis  is  to  design  a.  controller  that  would  decouple  the  dif¬ 
ferent  joints  of  finger  1  of  the  DH.  The  different  gain  blocks  in  the  analog  controller 
and  the  position  and  tendon  tension  sensors  were  calibrated.  The  gains  |.)roduced  by 
ihc  gain  blocks  were  found  to  vary  with  the  input  voltage.  Tlie  flexion  and  extension 
bias  settings  were  also  determined.  The  individual  joint  loop  transfer  functions  were 
computed  using  the  frequency  response  method,  and  were  determined  to  be  of  type 
zero.  There  is  a  significant  coupling  between  joints  1,  2  and  3.  The  coupling  was 

identined  and  an  algorithm  to  decouple  tlie  joints  was  developed.  The  decoupling 
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algoriUnn  was  simulated  using  the  SYSTEM.BUILD  utility  in  MATIUX,.  The  simu¬ 
lation  results  show  that  the  algorithm  wa-s  able  to  reniove  coupling  between  the  joints. 
Software  code  to  implement  this  algorithm  was  written  in  ‘C’  programming  language. 

7.1  RECOMMENDATIONS 

The  following  recommendations  are  made  to  improve  the  existing  control  system  : 

1.  It  was  found  that  there  is  a  steady-state  error  between  the  position  output  and 
input  when  a  step  input  is  applied  to  the  joints.  This  is  due  to  the  fact  that  the 
transfer  functions  of  tl.e  joints  are  of  type  zero.  One  way  to  remove  this  error 
is  by  adding  an  integral  term  to  the  existing  PD  controller,  wlddi  would  result 
m  zero  steady-state  error  to  a  step  input.  1'lie  eri’or  can  also  be  ix'duced  by 

introducing  a  gain  factor  outside  the  position  loop  of  individual  joints,  (figure 

6.25). 

2.  The  gains  produced  by  different  gain  blocks  of  the  analog  contioller  are  de¬ 
pendent  upon  tlie  magnitude  of  the  inputs  (Appendix  I).  Further,  the  control 
parameters  A,,  and  A'„  cannot  be  set  to  a  value  greater  than  10.  The  analog 
controller  can  be  replaced  by  a  microprocessor- based  digital  controller.  This 

would  enable  the  user  to  set  precise  gain  factors  and  set  Kj,  and  to  larger 
values. 

3.  A  lurther  study  should  be  made  to  determine  the  reasons  for  the  coupling 
between  joints  and  also  the  effect  of  changes  in  cocontraction  on  the  transfer 


iiinctions  of  individual  joints. 
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APPENDIX  A 
NOTATIONS 


GPVCALxy 

GEFCALxy 


P.xyCAL 


TxyFCAL 

TxyECAL 


PD 


POS 

EXT 


FLX 


GP 


GV 


•  finger  X  joint  y  ,  0  <  .r  <  3,0  <  ?/  <  3 

Static  calibration  data  file  of  position  and  velocity  gain  control 
blocks,  finger  x  joint  y 

Static  calibration  data  file  of  extension  and  flexion  gain  blocks 
of  finger  x  joint  y 

-  Static  calibration  data  file  of  the  position  Jfall  effect  sensors 
of  finger  x  joint  y 

Calibration  data  file  of  the  flexion  tendon  t(nision  sensor 
of  finger  x  joint  y 

Calibration  data  file  ol  the  extension  tendon  tension  sensor 
of  finger  x  joint  y 
Position  desired 

~  1  osition  output  of  the  Hall  effect  sensor 

-  Output  of  the  extensor  tendon  tension  sensor 

-  Output  of  the  flexor  tendon  tension  sensor 

-  Cain  setting  of  the  position  gain  block 
“  Gain  setting  of  the  velocity'  S^'in  block 
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Gain  setting  of  the  extension  gain  block 

GF 

-  Gain  setting  of  the  flexion  gain  block 

BE 

Extension  bias  setting 

BF 

-  Flexion  bias  setting 

Open  loop  transfer  function  of  finger  x 

'Jlx(s) 

Closed  loop  transfer  function  of  finger  x  joint  x 

'roM 

transfer  function  of  coupling  between  the  onl.put  of 
Joint  X  and  output  of  joint  y  due  to  an  input  at  joint 

■llyis) 

transfer  function  of  coupling  between  input  of 
joint  X  and  output  of  joint  y  due  to  an  ini)ut  at  joint 

~  input  at  joint  x 

Us) 

-  output  at  joint  x 

f\  p 

proportional  constant  of  the  PID  controller 

}\  y 

differential  constant  of  the  PID  controller 

U 

Gain  factor  of  the  differentiator  circuit 

Ki 

-  integral  constant  of  the  PID  conti-oller 

appendix  b 


CALIBRATION  TABLES  AND  PLOTS 


lliis  section  gives  the  tables  and  plots  of  the  calibrat 


‘ition  of 


1.  Position,  flexion  and  extension  gain  blocks  of  joints  0,  1  2,  and  3  of  lingei-  1 

2.  I'osilioii  sensors  of  joints  0.  1 ,  2  and  3  of  finger  1 


3.  I'lexion  and  extension  tendon  tension 


sensors  of  joints  0,  1,  2  and  .3  of  finocr 
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igure  B1  Position  Gain  Block  Calibrati 
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Figure  B2  Flexion  Gain  Block  Calibrati 


Figure  B3  Extension  Gain  Block  Calibration 
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Figure  B7  Flexion  Tendon 
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C4  U 


v'Vf ;^;j. 


i3B 


EXTENSION  bias 


POOITION 

EAAOA 


OEStREO 

EXTENSION 

TENSION 


Raw  Ki  1  L>Lf‘CAL<3| 
Static  calibration  of 
Pl'iqer  1,  joint  0 


e;:tBnsi on 


flexion  gain  control  block 


Table  B5  •  Calibration  table  of  flexion  gain  block 
Finger  1  Joint  0 


rj 


Kaw  Flic  ULI-CALOl 
Static  calibration  of 
Finger  1 ,  joint  1 


bration  uf  e^tonoion  •!<  F I  o::  i  on  gain  cunLrol  blocl. 
a  i  n  t  2 


f-iio  (;l;fcalo( 
Stixtic  c-alibration  of 
Finger  1,  joint  0 


e>:  tension 


•V  flexion  gain  control 


bloci 


*  I  dvsi  rod 
J  Input 
(c#Ic> 


1 


lO 


11 


1“ 


lA 


IS 


16 


17 


IP 


r*.» 


2i 


-9.  i.i9r 


-9,»:i9r 


-9. o9r 
*9*  092 


“9.092 


“9. 092 
-9.092 


-9.092 


"9.072 

"9.092 


"9.092 


-9.092 


-9. 091 
092 


-'5. 


-9. o92 


-9. 0^2 


-9.09: 


"9. Md: 


•CtU4l 

Input 

FLx-ru: 


— 10*  *i»0M 


—  10  -  *>'.»0 


-It*.  0'.»'!» 
—  1 0.  *!**.f0 


I  nput 
error 
(CJil  c ) 


0. 90B 
0-90e 


—  1 0  • 


-  1  .  0*.M> 


- 1 0 .  00*.* 


•  I O.  0'!*0 


—  10.  0'!*C* 


- 1 0.  •.H.*0» 


—  I  ‘j .  **»«!••> 


- 10. OoO 


- 1 0.  0*.'*.* 


—  10.  *!*•.*'.• 


—  10.  *.**  *<  • 


—  1  .  0*  *'  • 


•  J  I  1.  I.H.H.I 


-  I  *.•-  * 


“  1  *!*  .  *.•*.»>.* 


-III.  OI.M.I 


—  I  '!• .  *!*'.*'.• 


O*  90B 
O.  eOB 


0.90G 

0.900 


o  .91:10 


0.  908 


0.90B 
0. 9i:»0 


0. 90B 


0. 900 


0.900 


0.900 


0. 9r.»B 


0.  9i.*B 


o.  9i:*e 


**.  9i.iB 


O.  90P 


j:^9i.»o 

o.  9*>(r 


gal  ritfd 
output 
FBO-Fio: 


0.992 


e.nor. 


p.»>;*2 


7.S99 


7.  ir»6 


6.662 


6.20s 


5.7^19 


.226 


6.029 


6.269 


2.920 


2.666 


:.9oe 


2.SS6 
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1 .676 


1 . 22*? 


0.70S 


O.  260 


-o. 


g«»in 

♦^Ctor 

<c#lc) 


9.90 


9.26 


0.01 


0.27 


7.06 


6.02 


S.77 


6.79 

6.22 


:..B2 


2.  29 


2.0] 


2.26 


1.0!: 


1.2s 


0.06 


**.27 


-O.  i.»0 


Table  B9 


g«i  n 
vol tAqe 
BF-FK12 


9.97S 


7.990 


S.996 

j ,  o*:**:* 


:*.999 


?.  V90 


0.996 


o.  oo*:* 


-0.996 


-1.997 


-2.990 


-2. 999 


— S.  00»!* 


-S.976 


-6.997 


-7.990 


-0.999 


-9.99S 


Calibration  table  of  extension  gain  block 
Finger  1  Joint  0 


Kdw  Kile  bl£ 
Static  cali 
Finqer  1,  j 


5 


Ki-^w  Flic  Utl-L:ALi:3 

Static  calibration  o-f  e::ten5ion  ?<  ^Iccion  gain  control  blocls 
Finger  1,  joint  2 


dc&i red 
Input 
c) 


•CtUAl 

input 

CXT-FU: 


-9,09 


-9. 091 


. o91 


-9 . 09 


-9.091 


-9.091 


-9.092 


-9,092 


-9 . 09 


-9. 092 
-9.092 
-9,092 
-9.1.192 
«»9. 092 
-9 ,  t  >92 
-9,  «.t92 
>9.092 
-9, 092 
-9.092 


—  I 


-10,  <!m>0 


—  I O,  00*.» 


—  JO,  ****.•*!» 


-10. 


—  10,  <!»«>»*> 


- 1 0.  0>'M.» 


- 10.  oOO 


— 10 , 0'!»0 


- 1  •> . 
-10. 000 
- 10.  *>o«;» 
- 1  <!» .  0**»«!» 
- 1  *.'• ,  0*.'»'.* 

—  10.  o*>«> 

- 1 «'» ,  •>«.*•> 

—  I O .  *>•!»«!• 

—  10, 

- 1  *'• .  0'‘»*.» 


(c«] c ) 


0.  900 


.  90B 


O.9U0 


0 . 908 


O,  906 


O.  900 


O.  908 


0.908 


O.  900 


O.  900 


0 .  9*;»B 


O.  9o6 
O.  90B 
0.900 
O.  9<  »0 
9>>0 
O,  900 

i>  .  9i  »0” 
0.900 
O.  9o0 
•  ' .  9i.»0 


n»d 

output 

EBO-FIJ; 


9.0^7. 


e.z 


7.90 


7.^41 


6.96 


6.420 


5.B77 


S. 


4 , 90U 


4.404 

2.899 
2.277 
2.B79 
2.  266 
I.B62 
1 . 266 
0.B27 


factor 
<calc ) 


11.01 


10. 


9.96 


pain 
vol tagc 
6E-F1J2 


9.99 


B.999 


7.990 


6.997 


5.996 


1.997 


0.996 


O,  *>X» 

-0. 996 
-1.997 
-2.990 
-2.997 
-5. 

-5.996 
-6.997 
-7. 990 
-0.999 
-9.995 


Table  Bll  Calibration  table  of  extension  gain  block 
Finger  1  Joint  2 
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l<OV4  J'llt.  UtFLT.L'jr* 

“nglr  ''  g-l-  control  blocls 


desirvd 
input 
(col  c ) 


-9 ,  OdT" 
-9,092 
*9,092 
*9,092 
*9,092^ 
*9,092 
*9,0^"" 
*9,092 
*9,092 
*9,092 
-9,092 
*9,092^^ 
^,o92 
*9,092"" 
*9,092 
^9,092  ‘ 
*9,092 
*9,092"" 
*9, 092 
-9 . 092 


actual 
input 
EXT-Pl j: 


*IO«  Oi>0 

*  1  'i*.  ooc* 

*  lU,  »>*  »M 

_*I*X000 
*!*■>,  0«.»0 

*  IQi ,  000 
*10,  0«.»«.» 
*IO ,  i.ii.iO 

*  1 0 , 0»  j<> 
*10,  O*'**!* 
—  10. 

*10,  <!»*>o 
—  I  •.» ,  0*>0 
*10. 0<j<.> 

*  I  ,  0«'M.> 

*  1  *.’»  •  •!».*•> 
*10,  *!“><!' 
- 1 1> ,  oi;i«> 
*  1 0  • 

*  1 0,  0<>'> 
*10. 


input 
error 
(cole ) 


O.  7oB 
0,9o0 
O.  9o8 
O.  9i:>8~ 
0,908" 
O. 900" 

o«  9oe 
*>,  9oF" 
0. 9og 
o,9og"~ 
O,90B  " 
0.90b" 
O,  906 
O,  9oB 

o,  9«:»b 

0,  909 

o .  9<:»o 

o.9otr' 

O,  906 
0 , 90B 
O.  900 


pained 

output 

EGU-PU: 


7,622 
7,  M2. 
6,7U7 
6,^35 
6,057 
5,6^n 


factor 
(calc ) 


2.9>15 
2.S7B 
2,  185 
1 , 799 

i.^rs 
1 . 05«:» 
0,  673 
O.  276 


g 

vol tape 

Gt-rur. 


.  9.995 
B,997 
7,97f? 

6.997 
5.976 
5, 000 

3.997 
2,97B 

1 . 997 
0,996 
O,  <!»<.»0 

*0,976" 

*  1 . 997 

*2,976 

*3,999 

*5 , 00*. » 

*5,996" 

*6.997 

*7,99B 

*9,999 

*9,995 


Table  Bl2  Calibration  table  of  extension  gain  block 
Finger  1  Joint  3 


Kow  Kile  bhVLriLOl 

Stettic  calibration  o*f  post  ion  .T<  vol  oc  i  ty  qai  n  control  blocK 
F i nqpr  1 ,  jui nt  0 


desired 

input 

VD-FIJO 


0.B9B 


0.89B 


0.890 


0.890 


0.890 


0.  090 


0.870 


0.890 


0.  890 


0.890 


O.  890 


0.890 


O.  890 


0.  890 


0.890 


0.890 


0.898 


0.870 


0.898 


O.  890 


0.898 


-0.890 


-0.890 


-0.890 


-0.890 


-0. 890 


-0. 898 


-<».B9B 


-0.890 


-0.890 


-0.890 


-0.890 


-0.890 


-0.898 


-0.890 


-0.890 


-0.890 


-0.890 


-0.890 


-0.890 


-O. 898 


-0.898 


«C tu«l 
i  nput 
VEL-FIJO 


0.897 


0.897 


0.890 


0.096 


0.877 


0.897 


n.e76 


0.897 


0.870 


•  *.898 


0.89  7 


0.897 


0.890 


0.  8V0 


O.8*i0 


.896 


O.  8V7 


O.  098 


O.  890 


0.890 


0.877 


-O. 89 n 


-0.894 


-0.876 


-0. 874 


-0. 876 


-0.89 


-0.89 


-0.896 


-0.894 


-O.  89 


-0.896 


-0.  89 


-0.076 


-0.89 


-0.894 


-0.896 


-0.894 


-0.874 


-O.  89 


-0.894 


-0.894 


i  rvput 
©rror 
<c#ij  c ) 


0.897 


0.897 


O.  898 


0.896 


0.897 


0.897 


0.896 


0.897 


0.098 


«».89e 


0.89  7 


0.897 


0.890 


0.890 


0 .  890 


O.  H96 


U.  tW7 


0.898 


O.09U 


0.898 


0.897 


-0.894 


-0.894 


-O. 896 


-0.894 


-0.896 


-O.  89 


-O.  89 


ga  1  r%c»U 
output 
CC4l C ) 


lactor 
(Ci«l  c> 


voi tAge 
PV-FIJO 


19.71- 


10.  10 


16.470 


14.91- 


ir-.  :^i  I 


1  1 . 697 


lO. 107 


8. 


6.914 


*.  :.4o 


;.  744 


.  1  76 


0.619 


•>  ,  •  »«  mJi 


18. 76 


16.6 


14.84 


7.  or 


11. 


9.4P 


7.  /I 


-0.896 

-19.04T 

-0,894 

-17.467 

-0.89 


-0.896 


-0.89 


-0.896 


-O.  89 


-0. 894 


-0.896 


-0.894 


-0.894 


-0.89 


-0.894 


-«>.B94 


•n.ri 


-9.668 


-8.119 


19. 


17.76 


16.00 


14. 


10.01 


9.09 


.998 


1.997 


0.996 


.  *.*<>*.» 


-0.996 


-1.997 


-r.990 


-7.999 


6.  V97 


7.998 


8.999 


9,99 


9.99 


8.999 


7. 990 


6.997 


S.996 


.999 

r.99e 

1.997 

0.996 


O  •  O^”.* 


0.  996 


1.997 


r.  998 


.999 


5.  0O<> 


5.996 


6.977 


7.998 


8.999 


9.99 


Table  Bl3  Calibration  table  of  velocity  gain  block 
Finger  1  Joint  0 


Kuw  f- 1  1  r:-  I.ii  VLVM.O/ 

'in«cr  -lo.. 


d«*t  I  red 

input 

vD-ruii 


0.e9B 


0,690 


0.690 


0.696 


0.690 


0.690 


0.690 


.».690 


O.  690 


0.690 


0.690 


0.690 


0.090 


0.890 


0.090 


0.690 


0,670 


0.690 


M.69B 


0.696 


0.690 


-0.690 


-0.690 


-0.690 


-0. 098 


-0.090 


-0.690 


-O.  690 


-0.690 


-<>.  690 


-0.690 


-0.890 


-0.690 


-0.090 


-0.690 


-0.690 


-0.090 


-0.690 
-O. 090 
-0.690 
-0-690 


•Ctu«l 
input 
VEL-n  JI 


0.896 


0.697 


0.697 


0.690 


0.097 


0.696 


0.697 


0.697 


0.697 


0.676 


0.698 


0.697 


0.896 


0.697 


0.697 


0.B9P 


0.890 


:*.B9B 


0.690 


0.677 


0.697 


-0.690 


-0. 096 


-0.077 


-0.096 


-0,097 


-0.096 


-0.097 


-0. 096 


-0.690 


-0.697 


-0.69B 


-0.677 


-0.697 


-0. 697 


-0.690 


-0. 690 


-0.690 


-0.69B 

-0.896 

-0.697 

-0.096 


1  nput 

•rror 
(C«lc ) 


0.876 


0.697 


0.697 


0.690 


O.  697 


0.096 


0.697 


0.69  7 


0.697 


0.696 


0.690 


0.697 


0.896 


0.697 


0.677 


0.B9D 


0.670 


0.690 


0.670 


0.697 


O.  697 


-0.870 


-0.696 


-0.697 


-0.696 


-0.697 


-O. 696 


-0.697 


-0. 696 


-0.B9B 


-0.697 


-0.690 


-0.697 


-O. B97 


:i.e97 


:».09B 


-0.690 


-O.B9B 


-0.B9B 

-0.696 

-0.697 

-0.696 


<|Ai  ned 

1  g.'iin 

output 

(coir) 

4  Actor 
Ccc»l  c ) 

0«iin 
vol t«q» 
6V-riJ| 


9.  in 


7.50L" 


5^679 


*0.6^ 


re.  67 


.999 


-S.  0*>»!* 


;^.976 


■6.997 


•7.990 


•6.999 


9.99 


9.99 


6.999 


7.990 


6.997 


5S.  996 


5 , 00*.* 


r.r77 


-1  l.Tv^ 


“lo. 191 


-B.  6r»0 


-7. 177 


-n. 1 1 1 
-r.6n 
-1. 

<1 , 


21.70 


19.90 


10. 


t6.!^l 


M.79 


7-.  06 


.  *.**.»o 


0.996 


1.997 


^ .  56 

r.9~ 

1.27 

-o  •  oo 


*6.997 

^.990 

*B.999 

*9.995 


Table  Bl4  Calibration  table  of  velocity  gain  block 
Finger  1  Joint  1 


162 


Kow  111  t?  (,»  vi.iiiL  j ;■ 
Static  cai i bratl on  of 
Firiqer  I,  joint  3 


position  !<  velocity  qain  control  Ijlocis 


cl»»i  r»d 

input 

VD-nJT. 

4CtlJ«l 

i  nput 
VEL-rur. 

1  nput 

error 

(Ci^l  c ) 

9«ined 

output 

ic*lcl 

Q*1  n 
^4Ctor 
<C«1  L  1 

8«in 
vol  tiiqe 
BV-FIJ7 

1 

0. 696 

0.890 

0.898 

vl.262 

22. 1 2 

9.992 

2 

<»•  B9B 

0.  890 

0.890 

29.892 

27.27 

6.999 

0.  896 

0.897 

0.897 

28.226 

21.46 

*  7.990 

4 

0.896 

0.898 

26.298 

29.  60 

6.997 

6 

U,  H9B 

0.  098 

0. 896 
0.89B 

0.896 

0  •  690 

5.996 

7 

0.  B9B 

0.870 

O.B90 

■BKZRBi 

BSSB 

2.  nOO 

7. 997 

8 

9 

*:»•  898 

0.898 

0.878 

0. 898 

O.B90 

1 1  uuu 

2.990"“ 

10 

0.  B9B 

0.897 

0.897 

I 

1  16.072 

20.27 

i’b.bo 

1.997 

796 

1 1 

o.  ove 

0.89P 

0.890 

UHBECSH 

17.t.il 

0.  M'l 

ir 

O.  898 

0.690 

0.898 

1  IT- 67:. 

J2.22 

— f  996 

1" 

M.B98 

0.690 

O.  890 

ir.iM9 

17.49 

* 1  - qqV 

14 

O.  898 

0.89  7 

n.897 

mntnAim 

1 

M.  8V8 

o.evB 

0.898 

1 6 

O.  B9B 

0.89B 

0.098 

7.Zh7 _ 

taBKIESsS 

17 

0.898 

0.899 

0.B99 

6.46 

IB 

0.690 

0.097 

0.897 

4.240 

4.77 

-6.997^ 

IP 

0.898 

0.89B 

0.870 

2.701 

7.01 

-7,990 

0.878 

0.89B 

0.890 

1.176 

1.71 

-8.997 

2) 

0.  890 

0.898 

0.898 

•*i ,  Tm'i 

-9 . 972 

22 

-0. 896 

-0.09S 

-0.892 

-70.617 

74 . 27 

9.992 

a. 

-*0.898 

-0.BV5 

-0.892 

-29.041 

6.999 

24 

-O.B90 

-0.B9S 

-0.892 

HRSiiTTB 

7.998 

2!!!/ 

-*.>.896 

-0.894 

-O. 094 

B^LAtS 

SqeS 

6.  997 

26 

*0. 898 

-0. 092 

-0.892 

2. 976 

“0.B9B 

-0.896 

-0.896 

-22.797 

2 .  *'M  iri 

-0.890 

-0.896 

-0. 896 

-.71.276 

7.  9P7 

-0. 898 

-0.094 

-0. 894 

-19.680 

22.0“*  1 

2.  9up 

-o.evB 

-0.896 

-0.896 

1  •  997*~ 

-0.B9B 

-0.897 

-0.097 

0. 976 

-0.898 

-0.896 

-0. 096 

-12.021  1 

16,79 

0  •  (‘ft  M  > 

WBMI 

-0.89H 

-0.096 

-O.B96 

BUUBBl 

12.  o9 

996 

-0.898 

-0.892 

-0.892 

BiplIBi 

17.76 

-1 .977 

-0.89B 

-0.896 

-0.896 

-10.410 

11.62 

-2. 990 

-0.898 

-0.892 

-0. 892 

-8.824 

9.89 

-7.979 

Bs 

-0.B9B 

-0.896 

-0. 896 

-7. 720 

B.  17 

—2.  *’*Oi  1 

HB3H 

-0.89B 

-0.896 

-0.896 

-2.779 

■KBSEl 

-2.  996^* 

o9 

-0.898 

-0.896 

-0.896 

-6,797 

0 

-0.898 

-0.894 

-0.894 

-2.692 

-7.99(1 

-0.898 

-0.892 

-0.892 

-1.172 

1.7! 

-8. 979 

-0;B9B 

-0. 896 

*0.696 

0  .  «>?M  J 

—0. 00 

-9.»9S 

Table  Bl6  Calibration  table  of  velocity  gain  block 
Finger  1  Joint  3 


63 


Raw  l•ilc  r  ilL^LA 
FIJI  Position  Cal 


Data  Set 


Finger  1,  Joint  1 


pos) 11  on 
rvstflng 
Icountsl 
ros-FiJi 

pctual 

position 

(cleg) 

ENC-FUl 

llnv  4it 

orror 

Itfrg) 

-70^0 

-0.0 

-0.7 

-2CMe 

-0.0 

-0.7 

0.7 

0.0 

-1907 

3.4 

0.3 

-1679 

7.3 

0.4 

-1471 

11.1 

0.4 

-lie: 

13-9 

0.7 

-917 

70.  4 

0.0 

-691 

24.7 

-O.  0 

13 

Bor 

49.9 

-0.7 

16 

iisr 

S6.e 

0.0 

17 

1491 

67.3 

0.2 

10 

1009 

69.4 

0.3 

19 

7037 

77.  1 

0.3 

70 

2033 

72.0 

0.5 

71 

1007 

67.9 

0.4 

72 

1479 

61.1 

0.0 

73 

1171 

53-3 

-0.2 

74 

001 

49.7 

-0.4 

73 

531 

44.9 

-0.5 

76 

157 

30.3 

-0.6 

77 

-344 

29.0 

-0.4 

70 

'-7B0 

22.5 

-0.2 

79 

-1313 

13.6 

0.2 

30 

-1669 

7.6 

0.4 

position  •  0. 0173^1  •  <pos  r»*ding>  ♦  ^.71 


Table  Bl7  Calibration  table  of  position  sensor 
Finger  1  Joint  1 


[f 


Fiaw  File  FllUALA  Data  Set  1 
FIJI  Position  Cal 


Finger  1,  Joint  1 


tfsts 

loop 

pDsi tl on 

rosdinp 

Icountsi 

eo5-nji 

•Ctu*] 
posi lion 
I0»Q) 
BNC-FIJI 

line  4 it 

•rror 

(dsQ) 

1 

-2046 

-0.0 

-0.7 

2 

-2046 

-0.0 

-0.7 

3 

-2046 

0.  0 

-0.* 

4 

-1945 

2.7 

0.2 

5 

-1559 

9.6 

0.4 

.6 

-126:  1 

14.6 

0.3 

7 

-693 

20.  7 

0.0 

B 

-541 

26.6 

—0 . 2 

9 

-221 

32.0 

-0.3 

10 

159 

36.5 

-0.4 

1  J 

439 

43.4 

-0. 3 

12 

653 

50.6 

-0.  1 

13 

1097 

55.2 

0.0 

14 

1371 

60.  0 

0.1 

15 

1613 

67.9 

0.4 

16 

204  1 

72.  1 

0.6 

17 

2041 

72.  1 

0.6 

le 

2r»c»5 

:  71.4 

0.5 

19 

1603 

67.6 

0.4 

20 

1521 

62.7 

0.2 

21 

1231 

57.4 

-0.0 

22 

779 

49.2 

-0.4 

23 

307 

40.9 

-0.6 

24 

-132 

33.3 

-0.6 

25 

-504 

27.1 

-0.4 

26 

-1053 

17.9 

0.0 

27 

-1466 

10.7 

0.3 

2e 

^1676 

4.0 

0.3 

29 

-2046 

-0.0 

-0.7 

30 

-2046 

-0.0 

-0.7 

position  •  0,CI73n  •  Ipos  rosding)  ♦  36.15 


Table  Bl9  Calibration  table  of  position  sensor 
Finger  1  Joint  1 


Kile  F12CALF  Dc»la  Sot  2 
F1J2  Position  Cal 


Plnger  1,  Joint  2 


Ipop 

poftition 

•clusl 

line  4it 

r»«di ng 

position 

prrof 

(counts  > 

ld*g)  . 

(d»g  > 

Pos-Fur 

ENC-FUr 

1 

•2046 

•0.0 

•0.  4 

7 

-70<  J 

0.2 

•0.  7 

j 

•1646 

4.7 

•0.  1 

4 

•1599 

9.7 

•O.  o 

5 

-IM9 

15.  1 

0.0 

6 

•1072 

2'‘».  0 

0.0 

7 

•624 

29.2 

0.  1 

B 

•299 

75.  6 

0.2 

9 

•57 

40.9 

0.7 

10 

207 

46.  1 

0.4 

S  J 

511 

52.2 

0.  7 

12 

677 

56.6 

0.  2 

1? 

1244 

66.6 

•0. 0 

J4 

1569 

77.5 

•0.  1 

IS 

IBP9 

79.5 

•0.2 

16 

2070 

62.4 

•0.  0 

17 

2029 

62.4 

•0.0 

16 

1647 

76.6 

•0.2 

19 

1591 

73.5 

•0.2 

2C» 

1261 

66.9 

•0.  1 

21 

977 

61.7 

•0.0 

22 

627 

54.7 

0.0 

27 

74 

47.  1 

“0.0 

24 

•474 

72.7 

•0.2 

25 

•947 

22.5 

•0.  1 

26 

•1746 

14,4 

•0.0 

27 

•1665 

6.0 

•0-0 

26 

•1946 

2.2 

•0.2 

29 

“2047 

0.0 

•0.  7 

70 

“2047 

0.0 

•0.  7 

pomitlon  »  0.020IJJ  •  Ipoft  rvAding)  ♦  41 ,6 


Tdble  B21  Calibration  table  of  position  sensor 
Finger  1  Joint  2 


^•«w  Kile  K12(JALF 

P1J2  Position  Cal 


Data  Set  1 


Pinger  1,  Joint  2 


dstft 

loop 

posi tl on 

roAdlng 

(counts) 

ros-ri jr 

sctu*} 

position 

(tfsg) 

CNC*riJr 

lino  fit 
•rror 

(dog) 

1 

*2047 

*0. 0 

-0.4 

2 

*2047 

-0.0 

-0.4 

*1B10 

5.0 

-0.2 

4 

*14B9 

11.6 

-0.0 

S/ 

*114- 

IB. 6 

0.0 

6 

1 

m 

22.9 

0.0 

7 

--6I2 

29.4 

0. 0 

e 

*399 

33.8 

0.2 

9 

*151 

36.  B 

0.  3 

10 

221 

46.4 

0.4 

11 

523 

52.4 

0.3 

12 

613 

5B.  1 

O.  1 

13 

1275 

67.  1 

-0.1 

14 

1677 

75.1 

-0.2 

15 

I9B9 

ei.5 

-0. 1 

16 

2032 

62.4 

1  *^0.0 

17 

2031 

62.4 

-0.0 

IB 

1944 

60.  6 

-0.  1 

19 

1475 

71.1 

*0. 2 

20 

1211 

65.9 

-0.0 

2] 

101 1 

62.0 

0.0 

41  4W 

B12 

5B.0 

0.0 

23 

60B 

53.9 

0.0 

24 

329 

4B.3 

0.0 

25 

*147 

36.6 

-0.0 

26 

*671 

27.9 

-0.  1 

27 

-1216 

17.  1 

-0.0 

26 

«-lfcB7- 

7.6 

-0.0 

29 

*2022 

0.6 

*0.3 

30 

-204 B 

0.0 

-0.3 

position  •  0.020J2S  •  (pos  rosding)  ♦  41  *59 


Table  B22  Calibration  table  of  position  sensor 
Finger  1  Joint  2 


170 


Raw  File  F13CALA  Data  Set  2 

F1J3  Fosition  Cal 

Repeat 

Finger  1,  joint  3 


■ 

position 

riisding 

fcounts) 

K)S-P1J3 

OCtuAl 

position 

(deg) 

tNC-nJ3 

1 1 n»  4 i t 
orror 

Cdeg) 

1 

-2»:»4 1 

-0. 0 

•> 

-204(1 

-<>.o 

Bra3S 

3 

-1927 

2.6 

■■SKHH 

4 

-1668 

6.  1 

r^iTi — 

5 

-1626 

9.5 

6 

-1434 

13.6 

7 

16.5 

e 

-917 

25.3 

9 

-779 

26.5 

10 

-555 

33.5 

0.3 

n 

-214 

41.2 

0.5 

12 

63 

47.9 

0.  6 

12 

426 

55.4 

0.5 

14 

645 

64.3 

0.2 

15 

1276 

73.5 

-0.2 

.  16 

1807 

65.0 

-0.4 

17 

2047 

90.7 

0.0 

le 

2047 

90. 6 

0.  1 

19 

1945 

66.2 

- ^oTr - 

20 

1621 

60.9 

-0.4 

21 

1366 

75.6 

-0.  3 

22 

1139 

70.4 

-O.  2 

23 

699 

AS.  4 

0.0 

24 

.596 

56.9 

0.2 

25 

213 

5C'.4 

0.3 

26 

-195 

41.4 

0.2 

27 

-677 

so.s 

-0.0 

2B 

-1069 

21.4 

-0.0 

29 

-1463 

12.7 

-0.  0 

20 

-1626 

4.9 

-0.2 

7* 

poftltion  •  0.022075  ♦  CpOft  reading)  ♦  45.4fi 

Table  B24  Calibration  table  of  position 
Finger  1  Joint  3 


sensor 


Raw  File  TlOFCALA 

RIJO  Flexion  Calibration,  0-l«w.  ih., 
Finger  1,  joint  0 


Table  B27 


Raw  File  T10FCALE< 

PI  JO  Flexion  Csli brat ion,  0-20-0  lbs 
Finger  1,  joint  0 


d<>t» 

4  1 j  on 
r »#dj  ng 
<COt»nlt ) 
TlX-FIvIO 

•ctu^l 

4  1  t-::iDri 

ilt4  ) 
TEN-Flvio 

lint  <il 

•r  r  C'» 

<)b<  > 

i 

*ro<F 

-0.  0 

0.4 

•i76r 

l.B 

0.  7 

*• 

0.7 

A 

-iiei 

•..«? 

0.7 

9.6 

— •!*.  0 

A 

-nr 

11.6 

0.4 

7 

)  17 

M.9 

0.  4 

e 

Z-AZ 

i&.o 

O.t 

*; 

BiA 

19.6 

o.r. 

10 

4>6Z 

ip.r 

-0.0 

1 1 

[■  ZOB 

ir.i 

-t‘».  7 

i: 

-111 

ii.r 

-0.  6 

ir> 

9.1 

-0.7 

^  i< 

*  1  OOt 

^ . : 

-0.  4 

i: 

^iA7A 

7.4 

-0.  1 

2^ 

-  1777 

1  .& 

0.  c» 

1*7 

-20^  A 

-  0  •  0 

0.  4 

•'JOri  «■  M,  ]  P-,  >  Df*  r*-|kdjng>  ^  IT- .7J 


Table  B28  Calibration  Table  of  Flexion  Tendon  Sensor 
Finger  1  Joint  0 


Raw  File  TlOFCALC 

FIJO  Flexion  Calibration,  0-30-0  lbs 
Finger  1,  joint  0 


4  1  fr::i  on 

•c  Ili*) 

lint  4it 

r»»di ng 

<  1 on 

•rror 

Ccounlfc) 

<1M) 

Ob-f  > 

FLK-rK’O 

TEW-riv’O 

1 

-0.  0 

0.  8 

-i7ef 

1.6 

0.6 

*  1 

7'. 

O.b 

A 

-ntb 

J..  9 

<.* .  T- 

e 

9.  1 

0 .  7 

_ 

11.7 

T 

7 

117 

ir.  0 

0.  7 

r-oT 

1^.9 

0.  7 

897 

70.7 

0.4 

10 

ir-rc. 

r  - .  4 

0.7 

11 

77 ,  C> 

1 .  »> 

i: 

19:.::. 

79.  7 

1 .7 

17 

1 7:.: 

76.6 

0. : 

i< 

It: ; 

74,4 

-0.6 

ir. 

1197 

i  71.4 

-1.1 

u 

77r 

;  c .  1 

-1.7 

17 

7^0 

IT..  1 

-i.r 

}h 

-91. 

17.  1 

-1. 1 

19 

9.7 
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Table  B44 


APPENDIX  C 


TABLES  AND  PLOTS  OF  TRANSFER  FUNCTION 

IDENTIFICATION 

'.riiis  .section  gives  the  tables  and  plots  of  identification  of  tivansfer  functions  of 
joints  0,  1,  2  and  3  of  finger  1  and  those  of  cou])ling  between  joints  1,  2  and  3  of  finger 
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GAIN  (dB)  phase  (degrees) 
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loe 
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gain  plot  obtained  from  experimental  data 
phase  plot  obtained  from  experimental  data 
gain  and  phase  plots  of  the  estimated  model 


Figure  Cl 


Gain  and  phase  plots  of  finger 
and  its  estimated  model 


1  joint  1 
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—  gain  plot  obtained  from  experimental  data 

plot  obtained  from  experimented  data 
*  *  *  gain  and  phase  plots  of  the  estimated  model 

Figure  C3  Gain  and  phase  plots  of  finger  1  joint  3 
and  its  estimated  model 


gain  (dB)  PHASE 


195 


frequency  (radians/second) 


gain  plot  obtained  from  experimental  data 
phase  plot  obtained  from  experimental  data 
gam  and  phase  plots  of  the  estimated  model 


figure  C4  Gain  and  phase  plots  of  output-output  coupling 
between  joints  1  and  3  and  those  of  their  estimated  model 
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gain  plot  obtained  from  experimental  data 
obtained  from  experimental  data 
*  *  *  gain  and  phase  plots  of  the  estimated  model 

Figure  C5  Gain  and  phase  plots  of  output-output  coupling 
between  joints  2  and  3  and  those  of  their  estimated  model 
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gain  plot  obtained  from  experimental  data 
phase  plot  obtained  from  experimental  data 
gain  and  phase  plots  of  the  estimated  model 


Figure  C6  Gain  and  phase  plots  of  input-output  coupline 
between  joints  1  and  3  and  those  of  their  estimated  model 
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gain  plot  obtained  from  experimental  data 
phase  plot  obtained  from  experimental  data 
gain  and  phase  plots  of  the  estimated  model 


Figure  C7  Gain  and  phase  plots  of  input-output  coupling 
between  joints  2  and  3  and  those  of  their  estimated  model 
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Figure  C8  Response  of  finger  1  joint  1 
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Table  Cl  Response  of  finger  1  joint  1 

with  open  position  loop  and  closed  force  loop 


FREQUENCY  RESPONSE  DATA  OF  FINGER  1  JOINT  0 


FREQUENCY  GAIN  PHASE  GAIN 

hertz  dB  deg  dB 


PHASE 

deg 


0.6283 

1.2566 

3.1416 

6.2832 

10.0531 

12.5664 

16.2734 

18.8496 

25.1327 

31.4159 

37.6991 

43.9823 

50.2655 

56.5487 

62.8319 

69.1150 

75.3982 

87.9646 

100.5310 

113.0973 

125.6637 

138.2301 

157.0796 


20.6531  0.0000 

20.7593  -2.8080 

20.3483  -4.3200 

19.0178  -10.0800 

17.6476  -12.9600 

16.7175  -18.7200 

15.6923  -22.1616 

15.0717  -21.6000 

13.1493  -27.3600 

10.9926  -37.4400 

8.8671  -43.2000 

6.5141  -47.1600 

4.7567  -53.2800 

3.3771  -54.0000 

2.1940  -59.0400 

1.3743  -70.5600 

0.2928  -69.1200 

-1.7596  -79.9200 

-3.8937  -87.8400 

-5.8198  -92.8800 

-7.0755  -95.0400 

-9.1407  -102.2400 
-10.9205  -114.8400 


20.4933  -2.3989 

20.4734  -4.7909 

20.3364  -11.8606 

19.8792  -22.9538 

19.0579  -34.5888 

18.4155  ^41.2246 

17.4137  -49.5046 

16.7133  -54.3506 

15.0752  -63.7977 

13.5862  -70.8855 

12.2504  -76.4605 

11.0494  -81.0334 

9.9622  -84.9154 

8.9695  -88.3023 

8.0559  -91.3214 

7.2085  -94.0583 

6.4173  -96.5724 

4.9719  -101.0892 
3.6709  -105.0920 
2.4813  -108.7066 
1.3803  -112.0102 
0.3515  -115.0535 
-1.0816  -119.2054 


Table  C2  Gain  and  phase  data  of  finger  1  joint  0 
and  of  its  estimated  model 


FREOUENCy  RESPONSE  DATA  OF  FINGER  1  JOINT  1 


FREQUENCY  GAIN 
hertz  dB 


PHASE  GAIN  PHASE 

deg.  dB  deg. 


0.6283 

1.2566 

3.1416 

6.2832 

10.0531 

12.5664 

16.2734 

18.8496 

25.1327 

31.4159 

37.6991 

43.9823 

50.2655 

56.5487 

62.8319 

69.1150 

75.3982 

87.9646 

100.5310 

113.0973 

125.6637 

138.2301 

150.7964 

163.3628 

188.4956 


22.1457 

22.1755 

21.8684 

20.7478 

19.2685 

18.5306 

17.4431 

16.7711 

13.8016 

11.1617 

8.6563 

6.8156 

5.3873 

4.2418 

3.2612 

2.3995 

1.5311 

0.1291 

-1.0717 

-2.3181 

-3.4439 

-4.3588 

-5.6576 

-6.6581 

-10.0212 


0.0000 

0.0000 

-1.4400 

-7.2000 

-12.9600 

-15.8400 

-19.3644 

-24.8400 

-30.2400 

-41.0400 

-45.3600 

-52.2000 

-59.0400 

-60.4800 

-66.2400 

-70.5600 

-73.4400 

-79.9200 

-82.0800 

-92.8800 

-95.0400 

-110.1600 

-116.6400 

-121.6800 

-149.0400 


21.9305 

21.9077 

21.7508 

21.2324 

20.3175 

19.6142 

18.5347 

17.7901 

16.0728 

14.5330 

13.1629 

11.9374 

10.8311 

9.8230 

8.8958 

8.0360 

7.2329 

5.7642 

4.4389 

3.2231 

2.0935 

1.0333 

0.0305 

-0.9240 

-2.7137 


-2.6151 

-5.2219 

-12.9116 

-24.8926 

-37.2929 

-44.2820 

-52.9326 

-57.9727 

-67.8047 

-75.2524 

-81.2068 

-86.1866 

-90.5008 

-94.3410 

-97.8305 

-101.0516 

-104.0608 

-109.5930 

-114.6350 

-119.3044 

-123.6726 

-127.7863 

-131.6775 

-135.3698 

-142.2269 


Table  C3  Gain  and  phase  data  of  finger  1  joint  1 
and  of  its  estimated  model 


freouency  response  data  of 


FINGER  1  JOINT  2 


FREQUENCY  GAIN 
hertz  dB 


PHASE  GAIN  PHASE 

dB  deg. 


0.6283 

1.2566 

3.1416 

6.2832 

10.0531 

12.5664 

16.2734 

18.8496 

25.1327 

31.4159 

37.6991 

43.9823 

50.2655 

56.5487 

62.8319 

69.1150 

75.3982 

87.9646 

100.5310 

113.0973 

125.6637 

138.2301 

150.7964 

163.3628 

188.4956 


22.1457 
22.1755 
21.8684 
20.7478 
19.2685 
18.5306 
17.4431 
16.7711 
13.8016 
11.1617 
8.6563 
6.8156 
5.3873 
4 .2418 
3.2612 
2.3995 
1.5311 
0.1291 
-1.0717 
-2.3181 
-3.4439 
-4.3588 
-5.6576 
-6.6581 
10.0212 


0.0000 

0.0000 

-1.4400 

-7.2000 

-12.9600 

-15.8400 

-19.3644 

-24.8400 

-30.2400 

-41.0400 

-45.3600 

-52.2000 

-59.0400 

-60.4800 

-66.2400 

-70.5600 

-73.4400 

-79.9200 

-82.0800 

-92.8800 

-95.0400 

110.1600 

116.6400 

121.6800 

149.0400 


4.9590 

4.9595 

4.9626 

4.9738 

4.9965 

5.0166 

5.0523 

5.0802 

5.1525 

5.2149 

5.2419 

5.2019 

5.0604 

4.7863 

4.3603 

3.7804 

3.0629 

1.3333 

-0.5846 

-2.5180 

-4.3819 

-6.1453 

-7.8031 

-9.3606 

-12.2105 


-0.6960 

-1.3922 

-3.4826 

-6.9808 

-11.2213 

-14.0865 

-18.3874 

-21.4401 

-29.1590 

-37.3455 

-46.0699 

-55.3461 

-65.1047 

-75.1771 

-85.3094 

-95.2095 

-104.6135 

-121.2843 

-134.8759 

-145.8021 

-154.6803 

-162.0401 

-168.2725 

-173.6531 

-182.5769 


Table  C4  Gain  and  phase  data  of  finger  1  joint  2 
and  of  its  estimated  model 


nuUKHZ)  ntEQCRAD) 

0.1000  0.0283 
0.2000  1.8566 
0.6000  8.1416 

1.0000  6.8832 
1.0000  10.0531 

2.0000  12.6664 

2.6000  16.2734 

8.0000  18.0406 
4.0000  85.1827 

6.0000  81.4150 

6.0000  87.0001 

7.0000  43.0823 

0.0000  60.8655 
0.0000  66.6487 

10.0000  02.0310 
11.0000  00.1150 

12.0000  75.8082 

18.0000  01.0814 
14.0000  07.0646 

15.0000  04.8478 

16.0000  100.6310 
17.0000  106.0142 
18.0000  118.0073 

10.0000  110.8805 

80.0000  125.0637 

82.0000  188.8301 

82.0000  138.8301 

80.0000  188.4056 


CA1N(DB)  PHASE  (DBG) 

0.0535  0.0000 

10.1417  >8.8080 

10.8058  >8.7440 

10.4437  -0.0240 

10.6104  >0.6040 

10.6215  -15.8640 

10.6336  >18.8564 

10.8714  >31.8840 

11.8288  >23.0040 

10.0138  >27.6040 

10.8270  -83.8640 

0.0716  >86.0640 

0.8556  -85.4240 

0.0668  -87.6840 

7.0588  >88.8040 

7.0747  -40.4640 

0.8216  -48.8840 

6.8760  -65.2240 

4.6011  >57.0240 

8.6271  -63.6040 

8.8705  -04.2240 

1.4430  -04.8240 

0.6541  -03.6040 

-0.4264  >08.0040 

>0.0006  -07.1040 

-2.0562  >77.1840 

-2.0562  >77.1840 

>0.0708  >05.0040 


QA1M(DB)  phase (BEG) 

0.0008 

-0.6054 

O.OOOl 

-1.1008 

0.0040 

-8.0763 

0.0760 

-6.0475 

0.0383 

-0.4001 

0.0038 

>11.0547 

0.0306 

-15.8054 

0.7860 

>17.0033 

0.6247 

>83.8005 

0.4230 

>88.0745 

0.1078 

>84.8050 

0.0205 

>80.0176 

0.0265 

-44.0503 

0.8100 

-40.6060 

7.0750 

-64.1670 

7.0248 

-68.0151 

7.2627 

-02.0855 

0.0013 

-06.0761 

0.6180 

>70.0020 

0.1807 

-74.0440 

6.7430 

>78.8425 

6.8544 

>81.0030 

4.0648 

>05.0074 

4.6752 

>08.1015 

4.1064 

-01.8538 

8.4134 

>07.0420 

8.4134 

>07.0420 

0.4882 

-116.6630 

Table  C5  Gain  and  phase  data  of  finger  1  joint  3 
and  of  its  estimated  model 
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COUPLING  data  of  finger 


JOINT  2  DUE  TO  A  tV  SINE  INPUT  AT 


finger  1  JOINT  1 


ORIGINAL  DATA  FIT  DATA 


FREQ (HI)  FREQ (RAD)  CAIN (DB) PHASE (DEG)  CAIN(DB)  PHASE (DEC) 


0.0600 

6.3142 

0.1000 

6.6263 

0.2000 

1 . 2666 

0 . 6000 

3.1416 

1 .0000 

6.2832 

1 . 6000 

9.4246 

2.0000 

12.6664 

2.6000 

16.7080 

3.0000 

18.8496 

4.0000 

26.1327 

6.0000 

31 .4169 

6.0000 

37.6991 

7.0000 

43.9823 

6.0000 

66.2656 

9.0000 

66.6487 

10.0000 

62.8319 

12.0000 

76.3982 

14.0000 

87.9646 

16.0000 

160.6310 

18.0000 

113.6973 

20.0000 

126.6637 

22.0000 

138.2301 

24.0000 

160.7964 

26.0000 

163.3628 

28.0000 

176.9292 

30.0000 

186.4956 

36.0000 

219.9116 

“12.8324  -180.0000 
-11. MBS  -176.3280 
-11.9271  -176.3260 
-11.9S43  -176.9400 
-12.0071  -173.8800 
-12.1764  -162.7200 
-11.9919  -171.3600 
-11.8010  -170.8200 
-11.7664  -162.7200 
-11.0627  -184.0800 
-8.9S67  -106. 1200 
-7.2376  -110.8800 
-6.0807  -116.2600 
-4.9216  -110.8800 
-3.3060  -130.3200 
-1.7902  -126.7200 
1.0146  -128.1600 
1.7017  -164.1600 
1.4246  -177.1200 
0.8626  -188.6400 
0.9316  -181.6200 
0.9888  -199.4400 
0.8213  -206.9200 
0.6266  -201.6000 
0.6993  -204.4800 
0.4238  -216.7200 
0.3646  -222.1200 


-12.0436  -179.6200 
-12.0430  -179.0399 
-12.0406  -178.0791 
-12.0234  -176.1868 
-11.9674  -170.3008 
-11.8326  -166.3016 
-11.6302  -160.2093 
-11.3326  -166.1196 
-10.9282  -160.1970 
-9.8164  -141.6467 
-8.4408  -136.7936 
-7.0202  -132.8828 
-6.7167  -132.3680 
-4.0067  -133.4723 
-3.7003  -136.6136 
-2.9814  -137.9989 
-1.9792  -143.1710 
-1.3676  -147.7996 
-0.9862  -161.6478 
-0.7372  -164.7871 
-0.6700  -167.3623 
-0.4630  -169.4681 
-0.3686  -161.2341 
-0.3066  -162.7269 
-0.2677  -164.0006 
-0.2203  -166.1012 
-0.1666  -167.2881 


Table  C6  Gain  and  phase  data  of  coupling  between  finger  1  joints  1  and  2 
and  of  its  estimated  model 
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COUPLING  DATA  OP  FINGER  1  JOINT  3  DUE  TO  A  SINE  INPUT  AT  FINGER  1  JOINT  1 


FREQ  FREQ 

r»d/s»c. 

0.0sep  0.314? 
0.1000  0.6?e3 
0.?000  1.2S66 
0.B0C0  3.1416 
1.0000  6.263? 

1.6000  6. 4246 
2.0000  12.6664 

2.6000  16.7060 
3.0000  16.8496 
4.0000  25.1327 
6.0000  31.4169 
6.0000  37.6991 
7.0000  43.9623 
6.0000  60.2666 
9.0000  66.6487 

10.0000  62.6319 
12.0000  76.3982 
14.0000  67.9646 
16.0000  100.6310 
16.0000  113.0973 
20.0000  126.6637 
22.0000  138.2301 
24.0000  160.7964 
26.0000  163.3626 
26.0000  176.9292 
30.0000  166.4956 
36.0000  219.9116 


CAIN  PHASE 

6B  dvp . 

-22.3052  -165.2400 
-22.4929  -166.4600 
-22  :>•  -e  -168.4800 
-22.6631  -160.7400 
-21  .8616  -167.3200 
-21 .1264  -146.8600 
-20.2001  -146.6600 
-19.6261  -163.9000 
-19.1260  -146.6800 
-16.4416  -146.8600 
•1 1  .2646  -146.6800 
-9.6118  -120.9600 
-8.6796  -161.2000 
-7.4045  -146.8600 
-6.3029  -166.2400 
-3.6992  -160.0000 
-0.6826  -198.7200 
-4.1605  -241.9200 
-13.2652  -241.9200 
-22.2789  -213.8400 
-23.2001  -237.8000 
-26.0624  -237.0000 
-24.7637  -260.0000 
-27.804?  -360.0000 
-22.9226  -360.0000 
-21.1698  -370.0000 
-19.8464  -370.0000 


CAIN  phase 

66  . 

-22.0002  -180.0400 
-21 .9999  -180.0800 
-21.9986  -180.1600 
-21.9699  -180.4005 
-21.9687  -180.8039 
-21 .9065  -181 .2131 
-21.8326  -161.6314 
-21.7372  -182.0619 
-21 .6190  -182.6085 
-21 .3110  -183.4664 
-20.8991  -184.6466 
-20.3692  -186.8016 
-19.7011  -187.3170 
-18.8660  -189.2209 
-17,8218  -191.7299 
-16.6069  -195.2387 
-12.6612  -209.3338 
-8.0438  -267.1140 
-12.4641  -317.9640 
-18.0053  -336.6406 
-21 .9109  -343.8120 
-24.8808  -347.2829 
-27.2680  -349.4980 
-29.3223  -361 .0103 
-31.0914  -352.1101 
-32.661?  -352.9488 
-36.9701  -354.3648 


Table  C7  Gain  and  phase  data  of  coupling  between  finger  1  jointsl  and  3 
and  of  its  estimated  model 


COUPLING  DATA  OF  FINGER  1  JOINT  I  DUE  TO  A  SINE  INPUT  AT  FINGER  1  JOINT 


FREQ  FREQ  CAIN  PHASE  CAIN  PHASE 

Ml.  4B  dps*-***  dB  dppr»»< 


•.•S«e  i.S149 

0.1000  0.0203 

0.2000  i.ssee 

0.0000  0.1410 

1.0000  0.2032 

1.0000  0.4240 

2.0000  12.0004 

2.0000  10.7000 

0.0000  10.0400 

4.0000  20.1027 

0.0000  01.4100 

0.0000  07.0001 

7.0000  43.0023 

0.0000  00.2OEE 

0.0000  00.0407 
10.0000  02.0310 

12.0000  70.0002 

14.0000  07.0040 

10.0000  100.0310 
10.0000  113.0073 

20.0000  12E.0037 

22.0000  130.230] 

24.0000  1B0.7OO4 

20.0000  103.3020 

20.0000  170.0202 

30.0000  100.4OEO 

3E.O000  210.011E 


>0.3006  -106.2400 
-0.2220  -100.4000 
-0.1 E70  >100.4000 
-0.1006  -100.2000 
-0.2010  -100.0000 
-0.3374  -104.1000 
-O.22E0  -104.1000 
-0.0400  -102.0000 
-0.0040  -100.0200 
-7.0033  -100.0200 
-7.0040  -102.0000 
-7.2070  -100.0200 
-S.0476  -100.7000 
-S.1013  -104.1000 
-4.1344  -100.0200 
-3.7014  -101.2000 
-2.0007  >140.0000 
-1.1009  -101.2000 
0.0000  -140.7000 
0.0112  -100.0200 
2.0270  -101.2000 
2.0030  -100.4000 
2.0209  -104.1000 
1 .0922  -177.0400 
1.0741  -171.3000 
1.4370  -172.0000 
0.9403  -103.0000 


-0.0943  -170.7020 
-0.0043  -170.0049 
-0.0043  -170.1000 
-0.0947  -177.0102 
-0.0901  -170.0009 
-0.0030  -173.0203 
-0.0002  -171.3023 
-0.0003  -100.0030 
-0.0337  -100.4021 
-0.3040  -101.1213 
•0.0010  -100.4033 
-0.0002  -140.0370 
•7.0000  -140.1000 
-7.0721  -141.4179 
-0.1010  -130.1041 
-0.3010  -130.1113 
•3.7020  -139.1010 
-2.0314  -142.4100 
-1.0009  -140.3100 
-1.3739  -100.0392 
•1.0000  -103.3030 
-0.0470  -100.0697 
-0.7103  -100.3097 
-0.0177  -100.3367 
-0.0030  -101.0006 
-0.0090  -103.3708 
-0.4441  -106.0017 


Table  C8  Gain  and  phase  data  of  coupling  between  joints  2  and  3 
of  finger  1  and  of  its  estimated  model 


APPENDIX  D 

PROGRAMS  IN  MATRIXx 

This  section  gives  the  description  of  the  file  format  used  to  translate  raw  data 
sets  to  a  MATRIXx  readable  form,  and  an  example  of  the  same.  This  sections  also 
contains  program  listings  of  two  programs  namely  : 

1.  PROGGPH 

This  program  is  used  to  find  gain  and  phase  between  input  and  output  of  a 
joint 

2.  PROGOOPC 

This  program  is  used  to  find  the  gain  and  phase  of  the  coupling  between  the 
output  of  the  joint  commanded  to  move  and  those  of  the  coupled  joints. 
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UTAH/MIT  DH  RAW  DATA  TRANSLATION  FOR 

MATRIX-X 

Given  below  is  a  description  of  the  file  format  used  to  translate  raw  data  sets  to 
a  Matrix-X  readable  form.  Each  file  contains  1  data  set.  The  MATRIX^  file  naming 
convention  is  ‘rawfile.set’  where  ‘rawfile’  is  the  original  raw  data  file  name  and  ‘set’ 
is  the  data  set  number.  MATRIXx  hies  are  80  column  ASCII  and  may  be  printed 
directly. 

In  the  following  description: 

‘a’  refers  to  a  character  in  an  alphanumeric  string, 

‘i’  refers  to  a  character  in  an  integer  string, 

‘f’  refers  to  a  character  in  a  floating  point  (real)  string. 


MATRIXx  file  format: 

!  j  RRRRRRRR 

Raw  data  file  name. 

//a 

Hand  indicator  (L  or  R). 

//  aaaaaaaaaaaaa 

Title  (up  to  80  characters). 

//  mil 

Data  set  number. 

j  j  aaaaaaaaaaaaa 

Data  set  notes  (up  to  80  characters). 

//  ii/ii/ii  ii:ii 

Data  set  time  stamp. 

//  ii 

Number  of  constant  parameters  (1  -  34) 

//ii 

,  Number  of  variable  parameters  (1  -  21). 

//  iiiii 

DT  =  iii 
FREQU  =  fFf.fF 
/ /  aaaaaaaa  fTfTfFfF 
// 

// 

// 

/ /  aaaaaaaa  fffFfFfF 
//  aaaaaaaa 

// 

// 

// 

j  j  aaaaaaaa 

XY  =  ... 

(fFMf  fFfFfff  fffFfff ... 

// 

// 

// 

fffFfff  fffffff  fffFfff...)  ; 


Number  of  loops. 

Loop  period  (1  -  255  mS). 

Drive  frequency  (Hertz). 

Second  constant  parameter  name  &  value. 


Last  constant  parameter  name  &  value. 
First  variable  parameter  name. 


Last  variable  parameter  name. 

Name  of  dataset  variable  for  MATRIXx. 
First  loop  of  variable  parameter  values. 


Last  loop  of  variable  parameter  values. 
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example  of  a  raw  data  file 

//CPCFllF 

//L 

//  closed  position  and  force  loops,  FIJI  for  a  8v  sine  wave 

//I 

// 


//  08/02/88  14:27 

//  28 

//  7 

//  385 

DT  =  78; 

FREQU  =  0.10; 

//  PD-FIJO 

0.00 

//  PD-F1J2 

41.87 

//  PD-F1J3 

45.12 

//  GP-FIJO 

1.00 

//  GP-FIJI 

0.75 

//  GP-F1J2 

1.01 

//  GP-F1J3 

1.01 

//  GV-FIJO 

-1.29 

//  GV-FIJI 

-0.55 

2M 


//  GV-F1J2 

-0.69 

//GV-F1J3 

-0.58 

//  GE-FIJO 

4.00 

//  GE-FIJI 

4.00 

//  GE-F1J2 

4.00 

//  GE-F1J3 

4.00 

//  GF-FIJO 

4.00 

//  GF-FIJI 

4.00 

//  GF-F1J2 

4.00 

//  GF-F1J3 

4.00 

//  BE-FIJO 

-3.50 

//  BE-FIJI 

-3.50 

//  BE-F1J2 

-3.50 

//  BE-F1J3 

-3.50 

//  BF-FIJO 

-3.50 

//  BF-FIJI 

-3.50 

//  BF-F1J2 

-3.50 

//  BF-F1J3 

-3.50 

//  PD-FIJI 

//  POS-FIJI 

//  PGO-FIJI 

//  FLX-FIJI 

//  EXT-FIJI 
//  EGO-FIJI 
//  FGO-FIJI 

XY  =  ... 


[36.17 

31.95 

0.24 

4.25 

3.05 

1.89 

3.74 

37.55 

33.11 

0.25 

4.30 

3.05 

1.90 

3.81 

38.94 

34.26 

0.27 

4.37 

3.03 

1.93 

3.83 

40.31 

35.35 

0.29 

4.44 

3.03 

1.90 

3.86 

41.70 

36.37 

0.31 

4.54 

3.05 

1.89 

3.95 

43.05 

37.47 

0..32 

4.61 

3.04 

1.89 

3.97 

44.38 

38.52 

0.33 

4.68 

3.06 

1.84 

4.01 

45.72 

39.65 

0.35 

4.74 

3.07 

1.85 

4.06 

47.00 

40.79 

0.36 

4.78 

3.07 

1.81 

4.09 

48.28 

41.94 

0.37 

4.80 

3.09 

1.76 

4.12 

49.53 

43.07 

0.37 

4.82 

3.08 

1.80 

4.16 

50.74 

44.14 

0.38 

4.88 

3.06 

1.86 

4.17 

51.92 

44.99 

0.40 

4.96 

3.03 

1.95 

4.22 

53.05 

45.79 

0.41 

5.04 

3.02 

1.95 

4.28 

54.16 

46.76 

0.42 

5.09 

3.06 

1.86 

4.28 

55.22 

47.82 

0.42 

5.09 

3.08 

1.82 

4.27 

56.22 

48.91 

0.41 

5.07 

3.09 

1.76 

4.25 

57.18 

49.96 

0.41 

5.04 

3.09 

1;76 

4.24 

32.64 

28.78 

0.21 

4.15 

3.02 

1.94 

3.60 

33.93 

29.94 

0.23 

4.20 

3.02 

1.95 

3.66 

35.32 

31.14 

0.24 

4.25 

3.03 

1.92 

3.73  ]; 
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///////////////////////////////////////////////////////////////////////// 

///////////////////////////////////////////////////////////////////////// 

mill 

mill  PROGGPH 

//////  The  function  of  this  program  is  used  to  find  the  gain  and  phase 
//////  between  the  input  and  output  of  a  joint 

mm 

///////////////////////////////////////////////////////////////////////// 

///////////////////////////////////////////////////////////////////////// 

// 

///////////////////////////////////////////////////////////////////////// 

//  This  part  of  the  program  is  used  to  find  the  gain  in  decibels  (dB) 

// 

///////////////////////////////////////////////////////////////////////// 

// 

// 

dtl  =  dt  *  .001; 

//  dt  is  the  sampling  interval  of  data  collection,  dt  is  specified  in  the 
//  raw  data  file  as  n  where  n  is  the  sampling  interval  in  milliseconds. 

//  Hence,  it  is  multiplied  by  .001 
frequ, 

//  frequ  denotes  the  frequency  of  the  sine  wave  input 
pd  =  xy  (:,1); 

//  xy  is  a  matrix  which  has  as  its  columns,  the  sampled  data  of  different 
/ /  parameters  being  measured. 

//  pd  is  position  desired  i.e.  input  to  the  system 
rs  =  size  (pd); 
r  =  rs  (1); 

//  rs  is  a  2  X  1  matrix  whose  (1,1)  element  denotes  the  no.  of  rows  of  matrix  pd 
//  element  (2,1)  denotes  the  no.  of  columns  in  matrix  pd 
for  mn  =  1  :  r-1,.  .  . 

df  (mn)  =  [abs  (pd  (mn)-pd  (mn+1))];.  .  . 

end, 

//  df  is  a  column  matrix  of  the  differences  between  successive  readings 
//  of  the  the  pd  matrix  which  is  the  matrix  of  the  desired  position 
diffpd  =  max  (df); 

//  diffpd  has  the  maximum  difference  value  of  pd  (input  function)  matrix,  which 

//is  the  desired  position 

pdl  =  pd  (round  (r-0.75  *  r)  :  r); 

//pdl  is  a  column  matrix  which  has  the  last  1/4*'’  values  of  matrix  pd 

// 

pos  =  xy  (:,2); 


//  pos  is  a  column  matrix  containing  the  sampled  values  of  the  output 
for  op  =  1  :  r-l,.  .  . 

dfpos  (op)  =  [abs  (pos  (op)-pos  (op+l))];.  .  . 

end, 

diffpos  =  max  (dfpos); 

//  diffpos  has  the  maximum  difference  value  of  the  actual  position  matrix,  pos 

posl  =  pos  (round  (r-0.75  *  r)  :  r); 

maxpdl  =  max  (pdl); 

minpdl  =  min  (pdl); 

maxposl  =  max  (posl); 

minposl  =  min  (posl); 

magpdl  =  maxpdl  -  minpdl, 

//  magpdl  returns  the  magnitude  of  input 
magposl  =  maxposl  -  minposl, 

//  magposl  returns  the  magnitude  of  output 
gain  =  magposl/magpdl;  . 
dbgain  =  20  *  log  (gain)/log  (10); 

//  db  gain  returns  the  value  of  the  gain  (in  decibels) 
refpdl  =  maxpdl  -  (magpdl/2); 

//  refpdl  returns  the  reference  line  of  the  input  function 

// 

// 


///////////////////////////////////////////////////////////////////////// 

/////  This  part  of  the  program  is  used  to  find  the  phase  shift 

/////  in  degrees  between  input  and  output 

///// 

///////////////////////////////////////////////////////////////////////// 


q  =  0; 

for  s  =  round  (r-0.75  *  r)  :  r-l,.  .  . 
if  q  =  0,.  .  . 

if  pd  (s)  <  pd  (s+1),.  .  . 

if  abs  (pd  (s)-refpdl)  <2  *  diffpd/S,.  .  . 


q  =  s;.  .  . 
tin  =  dtl  *  s;.  .  . 
end,.  .  . 
end,.  .  . 
end,.  .  . 

end, 

//  tin  returns  the  time  at  which  the  input  function  crosses  the  reference  value 
refposl  =  maxposl-  (magposl/2); 

//  refposl  returns  the  reference  value  of  the  actual  position 
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qo  =  0; 

for  st  =  q  :  r-1,.  .  . 
if  qo  =  0,.  .  . 

if  pos  (st)  <  pos  (st+1),.  .  . 

if  abs  (pos  (st)-refposl)  <  2  *  diffpos/S,.  .  . 
tout  =  st  *  dtl;.  .  . 
qo  =  st;.  ,  . 
end,.  .  . 
end,.  .  . 
end,.  .  . 

end, 

tp  =  1/frequ; 

//  tp  returns  the  sampling  time  in  seconds 
phase  =  -  (  (tout  -  tin)/tp)  *  360; 

//  phase  returns  the  phase  shift  between  input  and  output  functions  in  degrees 


!////  PROGOOPC 

/////  This  program  is  used  to  find  the  coupling  between 
ii/ii  of  joint  1  and  outputs  of  joints  2  and  3 

1 1 

//  This  program  is  used  to  find  the  coupling  between  the  outputs  of  joint  1 

//  and  joint  2,  and  beWn  the  outputs  of  joint  1  and  joint  3  when  joint  1 
//  input  with  a  sinusoid. 

// 

// 
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IS 


// 


//  This  part  of  the  program  is  used  to  find  the  gain  in  decibels  (dB)  of  the 

// coupling  between  joints  ^ 


n 

dtl  =  dt  *  .001; 

//  fil'I  i"!  V'cified  in  the  law  data 

!o01  Hence,  it  is  mnitipied  by 

//  freqii  denotes  the  frequency  of  the  sine  wave  input  posl  =  xy  (;  2)-  //  xv  is  a 

measured  '  ParametLs //  being 

rs  =  size  (posl); 
r  =  rs  (1); 
clf=0; 

for  mn  =  1  :  r-1,... 

df  =  [df;abs  (posl  (mn)-posl  (mn+1))];... 

end, 

/  /  ll  differences  between  succesive  readings 

// ot  the  desired  position 

diffposl  =  max  (df); 

//  diffposl  is  the  value  of  the  maximum  difference  in  the  desired  position 
posll  =  posl  (round  (r-0.65  *  r)  •  rV 

// 

// 

dfpos2  =  0; 
dfpos3  =  0; 
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pos2  =  xy  (:,3); 
pos3  =  xy  (:,4); 

// 

for  op  =  1  : 

dfpos2  =  [dfpos2;abs  (pos2  (op)-pos2  (op+l))]; 

end, 

dilFpos2  =  max  (dfpos2); 

//  of^oinf  2'  niaximum  difference  in  the  position  output 

for  op  =  1  :  r-1,... 

dfpos3  =  [dfpos3;abs  (pos3  (op)-pos3  (op+l))]- 

end, 

diffpos3  =  max  (dfpos3); 

//  Sinf  3'  i"  ‘he  position  output 

posl2  =  pos2  (round  (r-0.65  *  r)  :  r); 
posl3  =  pos3  (round  (r-0.65  *  r)  :  r); 
maxposll  =  max  (posll); 
minposll  =  min  (posll); 
maxposl2  =  max  (posl2); 
minposl2  =  min  (posl2); 
maxposl3  =  max  (posl3); 
minposl3  =  min  (posl3); 

// 

magposll  =  maxposll  -  minposll; 

// 

rnagposl2  =  maxposl2  -  iuiiiposl2; 
gain2  =  magposl2/magposIl; 
dbgain2  =  20  *  log  (gain2)/log  (10), 

niagposl3  =  maxposl3  -  minposl3; 
gain3  =  magposl3/magposll; 
dbgain3  =  20  *  log  (gain3)/log  (10), 

// 

/ /  the  following  part  is  used  to  find  the  phase  shift 
refposl  =  maxposll-  (magposll/2); 
q  =  0; 

for  s  =  round  (r-0.8  *  r)  :  r-1,... 
if  q  =  0,... 

if  pos  (s)  <  pos  (s+l),... 

if  abs  (pos  (s)-refpo.sll)  <2*  diffpos/3,... 
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q  =  s;... 
tin  =  dtl  *  s;... 
end,... 
end,... 
end,... 

end, 

// 

refpo.sl2  =  maxposI2-  (ma.gposl2/2); 
qo2  =  0; 

for  st2  =  q  :  r-1,... 
if  qo2  =  0,... 

if  pos2  (st2)  <  pos2  (st2+l),... 

if  abs  (pos2  (st2)-refposl2)  <  2  *  difrpos2/3,... 
tout2  =  st2  *  dtl;... 
qo2  =  st2;... 
end,... 
end,... 
end,... 

end, 

tp  =  1/frequ; 

phase2  =  -  (  (tout2  -  tin)/tp)  *  360, 

/ /  phase2  is  the  phase  shift  between  the  outputs  of  joints  1  and  2 

// 

refposl3  =  maxposI3-  (ma.gposI3/2); 
qo3  =  0; 

for  st3  =  q  :  r-1,... 
if  qo3  =  0,... 

if  pos3  (st3)  <[  pos3  (st3"f"l ),... 

if  abs  (pos3  (st3)-refposl3)  <  2  *  diffpos3/3,... 
tout3  =  st3  *  dtl;... 
qo3  =  st3;... 
end,... 
end,... 
end,... 

end, 

phase3  =  -  ((tout3  -  tin)/tp)  ♦  360, 

/ /  phase3  is  the  phase  shift  between  the  outputs  of  joints  1  and  3 
table  =  [table;frequ  2  *  pi  *  frequ  dbgain2  phase2  dbgain3  phase3  ]; 
save  ’TABLEPC0011B8’  table; 

//  saves  variable  table  in  the  file  TABLEPC0011B8 


APPENDIX  E 


C  PROGRAM  LISTINGS 


This  section  gives  the  program  listings  of 

1.  PROGINTEGRAL  This  program  is  used  to  add  an  inte 

term  to  tlie  PD  controller 

2.  PROGDEGOUPLE  The  funcl  .ion  of  tins  program  is  to 

implement  the  decoupling  terms 


•m 


DIFFERENCE  EQUATION  DERIVATION 

Ihe  cIei]val;ion  of  the  clilTerence  equation  to  implement  the  integral  term,  vvhicli 
neecls  to  be  added  to  the  analog  servo  controller,  is  explained  below.  The  addition 

o(  the  integral  term  will  convert  the  PI)  controller  to  a  Pll)  controller.  'File  integral 
term  can  be  represented  as 


where 


K, 


Y(s)  Kj 

X(s)-  s 


gain  lactor  ol  the  integral  term 


llie  above  equation  is  converted  to  an  equation  in  z-domain  using  bi-linear  trans¬ 
formation  s  =  J 

i  (z-bl) 

which  I'esults  in  the  following  ecjuation 

XM  _  K,Tz  +  KrT 
X(z)  -  2z-2 

The  difference  e(|iiation  was  derived  which  is  given  below 

,y(/,)  =  +  y{k  - 

A  program  was  written  in  C  to  implement  the  difference  equation  which  is 


is  given 


below 


*****  PROGINTEGRAL 

*****  This  program  is  used  to  add  an  integral  term  to  the  PD  controller 
*****  This  program  reads  the  input  data  from  a.  file  named  input. dat 
*****  ^nd  writes  the  result  into  a  file  named  output.dat 

sH  jfc  :1c  sfc 

=(:*>t:=f!****!K***!)e  =t:*s|t**!|:>l=*******>(:*=|!=|:****>|:s|t***!H>|:  ******** 


#include  <stdio.h> 

#define  KI  1 
#def ine  T  0 . 1 

mainO 

{ 

float  x_last,  y_last,  x_now,  y_now,  cons,  T1 ; 

FILE  *inf ile ,*outf ile; 

if((infile  =  f open(" input. dat", "r"))  ==  NULL) 

{ 

perror (" input . dat ") ; 
exit (0)  ; 

} 

if((outfile  =  f open ("output. dat ","w"))  ==  NULL) 

{ 

perror("output .dat") ; 
exit (0)  ; 

> 

x_last  =0; 
y_last  =0; 
cons  =  KI  *  T/2; 

f  scant  (inf  ile,  "“/.f",  &x_now)  ; 

y_now  =  cons  *  x_now  +  cons  *  x_last  +  y_last; 
x_last  =  x_now; 

T1  =  T; 

fprintf (outf ile,"Tl\t\tXk\t\tYk\n") ; 

fprintf  (outfile,"%f\t/Cf\t/Cf\n",  Tl,  x_now,  y_now) ; 

while(fscanf  (inf ile,  "‘/.f",  &x_now)  !=  EOF) 

{ 
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T1  =  T1  +  T; 
y_last  =  y_now; 

y_now  =  cons  *  x_now  +  cons  ♦  x_last  +  y_last; 
fprintf  (outfile,"y,f\t’/.f\ty.f\n",  Tl,  x_now,  y_now)  ; 
x_last  =  x_now; 

} 

fclose(inf ile) ; 


} 


DIFFERENCE  EQUATION  DERIVATION 


The  decoupling  terms  TyyT^y  in  the  unreduced  form  result  in  being  fourth  order 


systems  of  the  general  form  given  below 
^yy  ■‘^^yK^J  — 

II  a  reduced  order  equation  is  used,  the  correponding  terms  in  the  equation  given 
above  can  be  set  to  zero.  Using  bi-linear  transformation  s  =  WlW  the  s-domain 

•I  1^+1)  ’ 


As''  +  Bs^  +  Cs^  Ds  4-  E 
Fs'^  +  Gs^  +  Hs^  +/s  +  J 


eciuation  is  converted  to  an  equation  in  z-domain  which  is  given  below 

XIA  ^  AAz''  +  BBz^  +  CCz"^  +  DDz  4-  EE 
A  (z)  FFz''  +  GGz^  +  II Hz'^  +  IIz  +  .1.1 

wliere 


AA  =  16/1  +  SBT  +  4GT^  +  2DT^  +  ET' 
nil  =  -647?  -  167?r  +  ADT^  +  AET' 

GG  =  96/1  -  SCr^  +  QET' 

DO  =  -64/1  +  16/Jr  -  4.Dr^  +  AET^ 

EE  =  16/1  -  87?T  +  AGT'^  -  2DT‘^  +  JT' 

FF  =  USE  +  ^GT  +  AIIT^  +  2/T^  +  .IT' 

GG  =  -646'  -  166r  +  AIT^  +  4Jr' 

HH  =  96F  -  %IIT^  +  6Jr' 

II  =  _64F  +  166r  -  AIT^  +  4Jr* 

JJ  =  16F  -  S6r  +  4//T2  +  2IT^  +  JT^ 

The  z-domain  equation  is  converted  to  a  a  difference  ecjuation  which  is  given 


below 


•J28 


A 


code  was  written  in  ‘C’  for  the  differ 


ence  equation  which  is  given  below.  Tliis 


piogram  uses  fOi2  (5.12)  as  an  example. 
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Iin*v,  progdecouple 

T*l***  ti'nction  of  this  program  is  to  implement  the  decoupling  terms 


#include  <stdio.h> 

#def ine  AO 
#define  B  0 
#define  Cl 
#define  D  48 
#define  E  900 
#define  F  0 
#define  GO 
#define  HI 
#define  I  96 
#define  J  3600 
#def ine  T  0 . 1 

mainO 

{ 

float  x_lastl,  x_last2,x_last3,  x_last3,  x_last4,  y_lastl,  y_last2; 

float  y_last3,  y_last4,  x_now,  y_now,  Tl; 

FILE  *infile,  *outfile; 

if((infile  =  fopen("input .dat" , "r") )  ==  NULL) 

{ 

perror (" input . dat ") : 

exit(O) ; 

} 

if((outfile  =  fopen("output.dat","w"))  ==  NULL) 

{ 

perror ("output .dat") ; 

exit(O); 

} 

x_lastl  =0; 
x_last2  =  0; 
x_last3  =  0; 
x_last4  =0; 
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y.lastl  =0; 
y_last2  =0; 
y.lastS  =0; 
y_last4  =0; 

AA  =  16*A  +  8*B*T  +  4*C*T*T  +  2*D*T*T>i 

+  E*T*T*T*T*T; 

BB  =  -64  *  A  -  16*B*T+4*D*T*T*T 
+  4*e*t*T*T*T*T; 

CC  =96*A-8*C*T*T 

'+6*E*T*T*T*T*T; 

DD  =  -64  *A+16*B*T-4*D*T*T*T 

+  4*E*T*T*t*T*T; 

”^®*A-8*B’I'T  +  4*C*T*T-2*D*T*X* 
+E*T*T*T*T*T; 

FF  ~16*F  +  8*G*T  +  4*H*T*T+2*I%T’I'T* 

+J*T*T*T*T*T; 

GG  =  -64  *F-16*G*T+4*I*t*T*T 
+  4*J*T*T=)'T*t*T; 

HH  =  96*F-8*H*T*T 

+  6*J*T*T*T*T*T; 

II  =  -64  *F+16*G*T-4*I*T*T*T 
+  4*J*t*T*T*T*T; 

33  —  16^F  —  8^G^T  +  4^H^T^T  — 

+  J*T*T*T*T*T; 

fscanf  (infile,  "‘/.f",  &x_now)  ; 

y.now  =  (AA/FF)  *  x_now  +  (BB/FF)  *  x.last.i  +  (CC/FF)  *  x 

+  (DD/FF)  *  x_last3  +  (EE/FF)  *  x_last4  -  (GG/FF) 

-(HH/FF)  *  y_last2  -(II/FF)  *  y_last3  -(JJ/FF)  *  v 
T1  =  T;  ^ 

f printf (outf ile . "Tl\t\t\tXk\t\tYk\n") ; 

fprintf(outfile,"y.f\ty.f\t*/.fW,  Tl,  x_now.  y.now); 

x.lastl  =  x_now; 
x_last2  =  x.lastl; 

x. last3  =  x_last2; 
x_last4  =  x_last3; 

y. lastl  =  y.now; 
y_last2  =  y.lastl; 
y_last3  =  y.last2; 
y_last4  =  y_last3; 


T 

T 


T 

:.last2 
*  y.lastl 
_last4; 


while  (fscanf (infile, &x  now)  !=  EOF) 

<■ 

.T1  =  T1  +  T; 

y_now  =  (AA/FF)  *  x_now  +  (BB/FF)  *  x_last_l 

+  (CC/FF)  *  x_last2  +  (DD/FF)  *  x_last3 

+  (EE/FF)  *  x_last4  -  (GG/FF)  *  y.lastl 

-  (HH/FF)  *  y_last2  -  (II/FF)  *  y_last3 

-  (JJ/FF)  ♦  y.last4; 

fprintf (outf ile, "'/,f\t*/,f\t*/of \t\n" ,  Tl,  x_now,  y_now 

x_lastl  =  x_now; 

x_last2  =  x_lastl; 

x_last3  =  x_last2; 

x_last4  =  x_last3; 

y_lastl  =  y_now; 

y_last2  =  y_lastl; 

> 

f close(inf ile) ; 
fclose(outf ile) ; 


appendix  f 


GAIN  BLOCK  CHECK 


llie  gam  blocks  in  the  analog  controller  do  not  produce  vciy  accurate  gains.  This 
section  gives  data  of  the  gains  produced  by  the  position  gain  block.  Tlie  notations 
used  and  their  explanations  are  given  below 


PD 


POS 


PGOACT 

PGOCAbC 


GA  INCA  LG 


position  desired  (in  degrees),  first  in]>ut  to  gain  block 
actual  position  (in  degrees),  second  input  to  gain  block 
actual  output  of  the  gain  block  =  0.1875  (PD  -  POS) 
calculated  output  ol  the  gain  block  wliicli  is  obtained  bv 
multiplying  the  difference  between  J^D  and  POS  by  0.1875 
calculated  gain  of  the  gain  block  which  is  obtained  by 
dividing  PGO  by  the  diffeience  between  PD  and  POS 


It  can  be  seen  from  the  column  GAINCALC  tliat  the  gains  are  very  different 
from  .1875  whicli  is  the  gain  to  which  the  gain  block  has  been  set.  Thus,  it  has  been 

pioved  that  the  gams  produced  by  the  different  gain  blocks  in  the  analog  controller 
are  not  accurate. 
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PD 

36.1700 
37.5500 

38.9400 
40.3100 
41.7000 
43.0500 
44.3800 
45.7200 
■  47.0000 
48.2800 
49.5300 
50.7400 
51.9200 
53 . 0500 
54.1600 

55.2200 

56.2200 
57.1800 
58.1000 

58.9400 


POS 

31.7600 

32 . 9400 

34.1000 

35.2100 

36.2700 

37.3100 

38.4000 

39.5300 

40.6700 

41.7800 

42.9300 

44 . 0400 

44.9900 

45 .8000 

46.7100 

47.6800 

48.7500 

49.7600 

50.7400 

51.6300 


PGOACT 

0.2500 
0 . 2700 
0.2800 
0.2900 
0.3100 
0.3300 
0.3500 
0.3500 
0.3600 
0 . 3700 
0.3800 
0.3800 
0.4000 
0.4100 
0.4200 
0.4200 
0.4200 
0.4200 
0.4200 
0.4200 


PGDCALC 

0.8269 
0.8644 
0.9075 
0.9562 
1.0181 
1.0763 
1.1212 
1.1606 
1.1869 
1.2188 
1.2375 
1.2563 
1.2994 
1.3594 
1.3969 
1.4138 
1.4006 
1.3912 
1.3800  ■ 
1.3706 


GAINCALC 

0.0567 

0.0586 

0.0579 

0.0569 

0.0571 

0.0575 

0.0585 

0.0565 

0.0569 

0.0569 

0.0576 

0.0567 

0.0577 

0.0566 

0.0564 

0.0557 

0.0562  • 

0.0566 

0.0571 

0.0575 


PD 


POS 


PGOACT 


PGOCALC  GAINCALC 


59.7600 

60.5100 

61.2000 

61.8200 

62.3900 

62.9000 


52.4100 

53.1200 

53.8000 

54.4400 

55.0300 

55.5300 


0.4200 

0.4200 

0.4200 

0.4200 

0.4200 

0.4200 


1.3781 
1.3856 
1.3875 
1 . 3837 
1.3800 
1.3819 


0.0571 

0.0568 

0.0568 

0.0569 

0.0571 

0.0570 


APPENDIX  G 


SIMULATION  PROGRAMS 

This  section  gives  the  program  listings  of  two  programs  namely  CRPROGBLS 
and  MODPROGBLS.  This  section  also  gives  the  figures  of  simulation  of  the  de¬ 
coupling  algorithm  in  MATRIXx. 
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////////////////////////////////////////////////////////////////// 

////////////////////////////////////////////////////////////////// 

///// 

/////  PROGRAM  CRPROGBLS 

/////  The  objective  of  this  program  is  to  simulate  the  servo  loops  of 
/////  joint  1 )  joint  2  and  joint  3  and  the  decoupling  scheme  using 
/////  SYSTEM-BUILD  in  MATRIX^ 

///// 

////////////////////////////////////////////////////////////////// 

////////////////////////////////////////////////////////////////// 

// 

// 

//  The  blocks  of  super-block  BLOCKl  are  defined  in 
//  the  following  section 
kpll  =8; 

/ /  proportional  gain  of  PID  controller  of  finger  1  joint  1 
kvll  =  2; 

//  velocity  gain  of  PID  controller  of  finger  1  joint  1 
kill  =  0; 

//  integral  gain  of  PID  controller  of  finger  1  joint  1 
kfll  =  1/124.31; 

gain  of  the  differentiator  of  finger  1  joint  1 
nil  =  3450  *  12.5/4; 
nmll  =  1; 

numll  =  convolve  (nil, nmll); 

//  numerator  of  plant  with  velocity  feedback 
dimnumll  =  size  (numll); 
sznumll  =  dimnumll  (2)  -  1; 

// order  of  numerator  of  joint  1 
dll  =  [1  245  3450]; 
dull  =1; 

dnell  =  convolve  (dll, dull); 
szdnell  =  size  (dnell); 
sz2dnell  =  szdnell  (2)  -  2; 

dnnll  =  [0  *  ones  (l,sz2dnell)  numll  *  kvll  *  kfll  Oj; 
denll  =  dnell  +  dnnll; 

//  denominator  of  open  loop  joint  transfer  function  with  feedback  controller 
dimdenll  =  size  (denll); 
szdenll  =  dimdenll  (2)  -  1; 

/ /  order  of  denominator  of  joint  1 
[sll,nsll]  =  sform  (numll, denll); 
gcnumll  =  kpll  ; 

//  numerator  of  feedforward  controller 


gcdenll  =  1; 

/ /  denominator  of  feedforward  controller 

gcgpnumll  =  convolve  (gcnumll,numll); 
gcgpdenll  =  convolve  (gcdenll, deni  1); 

[s,ns]  =  sform  (gcgpnumll, gcgpdenll); 

[sl,nsl]  =  feedback  (s,ns); 

[tnumll,tdenll]  =  tform  (sl,nsl); 

//  numerator  and  denominator  of  closed  loop  transfer  function  with  control! 
tnumll  =  gcgpnumll; 

// 

// 


illlljiiiiiiiiii ///// /// /// /////////////////////////////////////// 

I /ill  CODE  FOR  SUPER-BLOCK  BLOCKl 

///////// / /// // /// / !  Ill  H  III  II !  Ill  lllllll  III  III  III  II  III  II  III  mu 

U  The  blocks  of  super-block  BLOCKl  are  defined  in  the  following 
//  section  ° 

// 

build; 

Edit;  block];  0; 

Define;  11; 

Algebraic  Equations;  2; 

Block  name;  serll;  3;  2;  4;  1; 

Parameter  Entry;  2;  +1,-1; 

Define;  12; 

Gain  block; 


Block  name;  kpll;  3;  1;  4;  1; 
Parameter  entry;  kpll; 
Define;  2; 

Dynamic  Systems;  2; 

Block  name;  kill;  3;  1;  4;  1; 
Parameter  entry;  1;  kill;  y; 
Define;  13; 

Algebraic  Equations;  2; 

Block  name;  sell;  3;  1;  4;  1; 
Parameter  entry;  2;  +1,+1; 
Define;  14; 

Dynamic  Systems;  4; 


Block  name;  gpkvll;  3;  1;  4;  1;  5;  nsll; 

Parameter  entry;  sznurnll;  numll;  szdenll;  denll;. 

//  The  blocks  of  super-block  BLOCKl  are  connected  in  the  following 


/ /  section 
Connect; 

External  Input;  1;  11;  1,1;  0,0; 

Internal  Path;  11;  12; 

Internal  Patli;  11;  2; 

Internal  Path;  12;  13;  1,2;  0,0; 

Internal  Path;  2;  13;  1,1;  0,0; 

Internal  Path;  13;  14; 

Internal  Path;  14;  11;  1,2;  0,0; 

External  Output;  1;  14; 

top; 

mat; 

// 

// 

//////////////////////////////////////////////////////////////////y 

/////  PARAMETERS  OF  SUPER-BLOCK  T22  (FINGER  1  JOINT  2) 
/////  k  SUPER-BLOCK  BLOCK2 
///// 

/////////////////////////////////////////////////////////////////// 

/ /  Joint  2 

// 

kp22  =  8; 

//  proportional  gain  of  PID  controller 
kv22  =  2; 

//  velocit}^  gain  of  PID  controller 
ki22  =  0; 

//  integral  gain  of  PID  controller 
kf22  =  1/122.43; 

//  gain  of  the  differentiator  block 
n22  =  99.5.5. .55; 
nm22  =  1; 

num22  =  convolve  (n22,nm22); 

//  numerator  of  i.ransfer  function  of  joint  ]  with  feedback  controller 
d22  =  [1  90  5625]; 

dn22  =  l; 

dne22  =  convolve  (d22,dn22); 
szdne22  =  size  (dne22); 
sz2clne22  =  .szdne22  (2)  -  2; 

dd22  =  [0  *  ones  (I,sz2dne22)  num22  *  kv22  *  kf22  Oj; 
clen22  =  dnc22  +  dd22; 

//  denominator  of  transfer  lunction  of  joint  1  with  feedback  controller 


gcnum22  =  kp22; 

//  numerator  of  feedforward  controller 
gcden22  =1; 

/ /  denominator  of  feedforward  controller 
gcgpnum22  =  convolve  (gcnum22,num22); 
gcgpden22  =  convolve  (gcden22,den22); 

[s22,n,s22]  =  sform  (num22,den22); 

[st22,iist22]  =  sform  (gcgpnum22,gcgpden22); 

[stl22,nstl22]  =  feedback  (st22,nst22); 

[tnum22,tden22]  =  tform  (stl22,nstl22); 
tnum22  =  gcgpnum22; 

//  numerator  &  denominator  of  closed  loop  transfer  function  of  joint  2 
/ /  with  controller. 
pcool2num  =  [1  48  900]; 
pcool2den  =  [1  96  3600]; 

//  numerator  and  denominator  ol  output-output  coupling  between  joint  1 
//  and  joint  2. 

tnuml2  =  convolve  (tnumll,pcool2num); 
tdenl2  =  convolve  (tdenll,pcool2den); 

//  numerator  and  denominator  of  input-output  coupling  between  joint  1 
//  and  joint  2. 

[sl2,nsl2]  =  sform  (tnuml2,tdenl2); 
t22itl2num  =  convolve  (tden22,tnuml2); 
t22itr2den  =  convolve  (tnum22,tdenl2); 
dimnum22  =  size  (num22); 
sznum22  =  dimnum22  (2)  -  1; 
dimden22  =  size  (den22); 
szden22  =  dimden22  (2)  -  1; 

[sp22,nsp22]  =  sform  (num22,den22); 
dimnuml2  =  size  (tnuml2); 
sznuml2  =  dininuml2  (2)  -  1; 
dimdenl2  =  size  (tdenl2); 
szdenl2  =  dimdenl2  (2)  -  1; 

[sl2, 11812]  =  sform  (tnuml2,tdenr2); 
dimn22il2  =  size  (t22itl2num); 
szn22il2  =  dimn22il2  (2)  -  1; 
dimd22il2  =  size  (t22itl2den); 
szd22il2  =  dimd22il2  (2)  -  1; 

[s22il2,ns22il2]  =  sform  (t22itl2num,t22itl2den); 


////////////////////////////////////////////////////////////////// 

/////  SYSTEMJ3UILD  CODE  FOR  SUPER-BLOCK  T22 

///// 

////////////////////////////////////////////////////////////////// 

/ /  The  blocks  of  super-block  T22  are  defined  in  the  following 

//  section 

build; 

Edit;  t22;  0; 

Define;  11; 

Algebraic  Ecjuations;  2; 

Block  name;  ser22;  3;  2;  4;  1; 

Parameter  Entry;  2;  -f-1,-1; 

Define;  12; 

Gain  block; 

Block  name;  kp22;  3;1;4;1; 

Parameter  entry;  kp22; 

Define;  2; 

Dynamic  Systems;  2; 

Block  name;  ki22;  3;  1;  4;  1; 

Parameter  entry;  1;  ki22;  y; 

Define;  13; 

Algebraic  Ef|iiations;  2; 

Block  name;  sc22;  3;  1;  4;  1; 

I’arameter  entry;  2;  -t-1,+1; 

Define;  14; 

Dynamic  Systems;  4; 

Block  name;  gpkv22;  3;  1;  4;  1;  5;  nsp22; 

Parameter  entry;  sznum22;  niim22;  szden22;  den22; 

// 

//  The  blocks  of  super-block  T22  are  defined  in  the  following 

/ /  section 

Connect; 

External  Input;  1;  11;  1,1;  0,0; 

Internal  Path;  11;  12; 

Internal  Path;  11;  2; 

Internal  Path;  12;  13;  1,2;  0,0;  • 

Internal  Path;  2;  13;  1,1;  0,0; 

Internal  Path;  13;  14; 

Internal  Path;  14;  11;  1,2;  0,0; 

External  Output;  1;  14;  , 

top; 


// 

// 


'll'lll'llll'lllllllllllllllllllllllllllllllll^ 

nil  I  SYSTISMJ3UILD  CODE  FOR  SUPER-BLOCK  BLOCK2 


/////// mu  II  mill ///////////////////////////////////////////// 


//  The  blocks  of  super-block  BL0CK2  are  defined  in  the 
/ /  following  section 
Edit  Super-Block; 
block2;  0 


Define  Block;  1; 


Dynamic  Systems;  4; 

Block  name;  t22itl2;  3;  1;  4;  1;  5;  ns22i]2; 

Parameter  Entry;  sxm22il2;  t22it]2num;  s/,d22il2;  t22itI2dcir 
DeHne  Block;  4; 

Dynamic  Systems;  4; 


Block  name;  tl2;  3;  1;  4;  1;  5;  nsl2; 

Parameter  Entry;  sznuml2;  tnuml2;  szdcn]2;  tdenl*?- 
Define  Block;  13; 


Super-Block;  Block  name;  t22;  3;  1;  4;  1; 

Parameter  Entry; 

Define  Block;  14; 

Algebraic  Equations;  2; 

Block  name;  sol 2;  3;  2;  4;  1; 

Parameter  Entry;  2;  -1-1, -|-1; 

Define  Block;  11; 

Algebraic  Equations;  2; 

Block  name;  scrl2;  3;  2;  4;  1; 

Parameter  entry;  2; -I- 1,-1; 

/ /  The  blocks  of  super-block  BL0CK2  are  connected  in  the 

//  following  section 

Connect; 

External  Input;  2;  1;  1,1;  0,0; 

External  Input;  2;  11;  n;  2,1;  0,0; 

External  Input;  2;  4;  1,1;  0,0; 

Internal  Path;  1;  11;  1,2;  0,0; 

Internal  Path;  4;  14;  1,2;  0,0; 

Internal  Path;  13;  H;  1,1;  0,0; 

Internal  Path;  11;  13; 

External  Output;  1;  14; 
top; 


mat; 

// 

7/ 

// 

////////////////////////////////////////////////////////////////// 

///// 

/////  PARAMETERS  OF  SUPER-BLOCK  T33  (FINGER  1  JOINT  3), 
/////  SUPER-BLOCK  BLOCK3  AND  SUPER-BLOCK  BLOCK4 
///// 

////////////////////////////////////////////////////////////////// 

// 

//  The  values  of  the  different  blocks  of  super-blocks  T33, 

//  BLOCK3  and  BLOCK4  are  calcidated  in  this  section 
kp33  =  8; 

//  proportional  gain  of  PID  controller 
kv33  =  2; 

//  velocity  gain  of  PID  controller 
ki33  =  0; 

//  integral  gain  of  PID  controller 
kf33  =  1/120.46; 

//  gain  of  differentiator 
nm33  =  17787.94; 

//  numerator  of  open  loop  transfer  function  of  joint  3 
//  with  feedback  controller  , 
n33  =  1; 

num33  =  convolve  (n.3.3,nm33); 
dimnum33  =  size  (num33); 
sznum33  =  dimnum33  (2)  -  1; 
dn33  =  [1  340  22500]; 
d.33  =  l; 

dne33  =  convolve  (dn.33,d33); 
szdne33  =  size  (dne33); 
sz2dne.33  =  szdne3.3  (2)  -  2; 

dd33  =  [0  *  ones  (I,sz2dne33)  num33  *  kv33  *  kf33  Oj; 
den.33  =  dne33  -f  dd33; 

/ /  denomina  tor  of  open  loop  transfer  function  of  joint  3 
//  with  feedback  controller 
dimden33  =  size  (den33); 
szden33  =  dimden33  (2)  -  1; 

[sp33,nsp33]  =  sform  (num33,den33); 
gc33num  =kp33;  / /  numerator  of  feedforward  controller 
gc33den  =  1;  //  denominator  of  feedforward  controller 
gcgp33num  =  convolve  (gc33num,num.3.3); 


gcgp33deii  =  convolve  (gc33den,den33); 

[scp33,nsci333]  =  sform  (gcgp33num,gcgp33den); 

[st33,nst33]  =  feedback  (sci)33,nscp33); 

[tnum33,tden33]  —  tform  (st33,nst33); 

//  numera.tor  and  denominator  of  closed  loop  transfer  function  of  joint  3 

//  with  controller 

tnum33  =  gcgp33num; 

pcool3num  =  643.383; 

pcoolSden  =  [1  18  8100]; 

//  numerator  and  denominator  of  coupling  between 
//  outputs  of  joint  1  &  joint  3 
tnuml3  =  convolve  (tnumll,pcool3num); 
tdenl3  =  convolve  (tdenll,pcool3dcn); 

//  numerator  and  denominator  of  coupling  between 

//  outputs  of  joint  1  &  joint  3 

pcoo23num  =  .9576*[1  70  2500]; 

pcoo23den  =  [1  119  7225]; 

tnum23  =  convolve  (tnum22,pcoo23mim); 

tden23  =  convolve  (tden22,pcoo23den); 

t33itl3num  =  convolve  (tden33,tnuml3); 

t33itl3den  =  convolve  (tnum33,tdenl3); 

[s33il3,ns33il3]  =  sform  (t33itl3num,t33itl3den); 
t33it23num  =  convolve  (tden33,tnum23); 
t33it23den  =  convolve  (tnum33,tden23); 

[s33i23,ns33i2.3]  =  sform  (t.33it23num,t33it23den); 

[stl3,nstl3]  =  sform  (tnuml3,tden]3); 

[st23,nst23]  =  sform  (tnum23,tden23); 
dimnuml3  =  size  (tnuml3); 
sznuml3  =  dimnuml3  (2)  -  1; 
dimdenl3  =  size  (tdenl3); 
szdenl3  =  dimdenl3  (2)  -  1; 
dimnum23  =  size  (tnum23); 
sznum23  =  dimnum23  (2)  -  1; 
dimden23  =  size  (tden23); 
szden23  =  dimden23  (2)  -  1; 
dimn33il3  =  size  (t33itl3num); 
szn.33il3  =  dimn33il3  (2)  -  1; 
dimd33il3  =  size  (t33itl3den); 
szd.33il3  =  dimd33il3  (2)  -  1; 
dimn33i23  =  size  (t33it23num); 
szn33i23  =  dimn33i23  (2)  -  1; 
dimd33i23  =  size  (t33it23den); 
szd33i23  =  dimd33i23  (2)  -  1; 


////////////////////////////////////////////////////////////// 

/////  SYSTEM.BUILD  CODE  FOR  SUPER-BLOCK  T33 

///// 

////////////////////////////////////////////////////////////// 

//  The  blocks  of  super-block  T33  are  defined 

//in  the  following  section 

build; 

Edit;  t33;  0; 

Define;  11; 

Algebraic  Equations;  2; 

Block  name;  ser33;  3;  2;  4;  1; 

Parameter  Entry;  2;  -1-1,-1; 

Define;  12; 

Gain  block; 

Block  name;  kp33;  3;  1;  1;  1; 

Parameter  entry;  kp33; 

Define;  2; 

Dynamic  Systems;  2; 

Block  name;  ki33;  3;  1;  4;  1; 

Parameter  entry;  1;  ki33;  y; 

Define;  13; 

Algebraic  Equations;  2; 

Block  name;  sc33;  3;  1;  4;  1; 

Parameter  entry;  2;  -1-1,-1-1; 

Define;  14; 

Dynamic  Systems;  4; 

Block  name;  gpkv33;  3;  1;  4;  1;  5;  nsp33; 

Parameter  entry;  sznum33;  num33;  szden33;  den33; 

Connect; 

External  Input;  1;  11;  1,1;  0,0; 

Internal  Path;  11;  12; 

Internal  Path;  11;  2; 

Internal  Path;  12;  13;  1,2;  0,0; 

Internal  Path;  2;  13;  1,1;  0,0; 

Internal  Path;  13;  14; 

Internal  Path;  14;  11;  1,2;  0,0; 

External  Output;  1;  14; 
top; 


///////////////////////////////////////////////////////////////// 

///// 

II m  SYSTEM-BUILD  CODE  FOR  SUPER-BLOCK  BLOCK4 

///// 

///////////////////////////////////////////////////////////////// 

// 

//  The  blocks  of  super-block  BL0CK4  are  defined  in  the 
//  following  section 
Edit  Super-Block; 
block4;  0; 

Define  Block;  1; 

Dynamic  Systems;  4; 

Block  name;  tl3;  3;  1;  4;  1;  5;  nstl3; 

Parameter  Entry;  sznuml3;  tnuml3;  szdenl3;  tdenl3; 

Define  Block;  11; 

Dynamic  Systems;  4; 

Block  name;  t23;  3;  1;  4;  1;  5;  nst23; 

Parameter  EnI.ry;  szhum23;  tnum23;  szden23;  tdeii23; 

Define  Block;  21 ; 

Super- Block; 

Block  name;  t33;  3;  1;  4;  1; 

Parameter  Entry; 

Define  Block;  23; 

Algebraic  Equations;  2; 

Block  name;  so23;  3;  3;  4;  1; 

Parameter  Entry;  3;  -fl,+l,+l; 

//  The  blocks  of  super-block  BLOCK4  are 
//  connected  in  the  following  section 
Connect  Blocl\s; 

External  Input;  3;  1;  1,1;  0,0; 

External  Input;  3;  11;  2,1;  0,0; 

External  Input;  3;  21;  3,1;  0,0; 

Internal  Path;  1;  23;  1,1;  0,0; 

Internal  Path;  11;  23;  1,2;  0,0; 

Internal  Path;  21;  23;  1,3;  0,0; 

External  Output;  1;  23; 
top; 


////////////////////////////////////////////////////////////////// 

II m  SYSTEM-BUILD  CODE  FOR  SUPER-BLOCK  BLOCK3 

///// 

////////////////////////////////////////////////////////////////// 

"  r 

/ /  The  blocks  of  BLOCKS  are  defined  in  tlie  following  section 
Edit  Super-Block; 
blocks ;  0; 

Define  Block;  4; 

Dynamic  Sj^stems;  4; 

Block  name;  tSStlS;  S;  1;  4;  1;  5;  nsSSilS; 

Parameter  Entry;  sznSSilS;  tSSitlSnum;  szdSSilS;  tSSitlSden; 

Define  Block;  1; 

Dynamic  Systems;  4; 

Block  name;  tSSt2S;  S;  1;  4;  1;  5;  nsSSi2S; 

Parameter  Entry;  sznSSi23;  t33it23num;  szd33i23;  t33it23den; 

Define  Block;  13; 

Algebraic  Equations;  2; 

Block  name;  serl23;  3;  3;  4;  1; 

Parameter  Entry;  3;  -1-1,- 1,-1; 

//  The  blocks  of  super-block  BLOCKS  are  defined 

//  in  the  following  section 

Connect; 

External  Input;  3;  13;  n;  3,1;  0,0; 

External  Input;  3;  1;  2,1;  0,0; 

External  Jniuit;  3;  4;  1,1;  0,0; 

Internal  Path;  1;  13;  1,2;  0,0; 

Internal  Path;  4;  13;  1,3;  0,0; 

External  Output;  1;  13; 
top; 

// 

// 

///////////////////////////////////////////////////////////////// 

///// 

/////  SYSTEM-BUILD  CODE  FOR  SUPER-BLOCK  DEC 

///// 

//////////////////////////////////////////////////////•/////////// 

// 

/ /  The  blocks  of  siq^er-block  DEC  are  defined  in  the 
//  following  section 
Edit  Super-Block; 
dec;  0; 
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Define  Block;  2; 

Super-Block; 

Block  name;  blockl;  3;  1;  4;  1; 

Parameter  Entry; 

Define  Block;  12; 

Super-Block; 

Block  name;  bIock2;  3;  2;  4;  1; 

Parameter  Entry; 

Define  Block;  21; 

Super-Block; 

Block  name;  block3;  3;  3;  4;  1; 

Parameter  Entry; 

Define  Block;  22; 

Super-Block; 

Block  name;  block4;  3;  3;  4;  1; 

Parameter  Entry; 

Connect  Blocks; 

External  Input;  3;  2;  1,1;  0,0; 

External  Input;  3;  12;  1,1;  2,2;  0,0; 

External  Input;  3;  21;  n;  1,1;  2,2;  3,3;  0,0; 

External  Input;  3;  22;  n;  1,1;  2,2;  0,0; 

Internal  Path;  21;  22;  1,3;  0,0; 

External  Output;  3;  2;  1,1;  0,0; 

External  Output;  3;  12;  1,2;  0,0; 

External  Output;  3;  22;  1,3;  0,0; 

top; 

mat; 

save  ’spblocks’; 

//  saves  all  the  variables  and  the  super-blocks  in  the  file  ’spblocks’ 


j  j  j ! j !  . ^  f  f  f  f  f  i ! I  I !  f  i I  I! I  U  I  I ! I f  !  I !  I  !  I  !  I  i  I  If 

mill  ^  program  MODPROGBLS 

III  III  Junction  of  this  program  is  to  load  tJic  simulation  segments  into 

//////  MATRIXx  for  modifying  the  same  by  changing  the  various 
//////  PtU'S’nieters  of  the  models  of  the  different  joints 

mill 

//////////////////////////////////////////////////////////////////////// 

// 

//  Loading  ol  simulation  segments, 
load  ‘spblocks’ 

//  Loads  super-blocks  BLOCKl,  BLOCK2,  BL0CK3,  BL0CK4,  T22,  T33,  DEC 

// 

illlliiiiiiiiiiiiiiiiiiiiiiiiiiiiiiuiiiiiiiiiiiniiiiiiiiiiiiiiiii 

Hill  Pcarameters  of  super-block  BLOCKl 

mu 

iiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiii 

// 

kpll  =8; 

//  proportional  gain  of  BID  controller  of  finger  1  joint  J 
kvll  =  2;  '  ' 

//  derivative  gain  of  BID  contioler  of  finger  1  joint  1 

kill  =  I; 

//  integral  gain  of  finger  1  joint  1 
kfll  =  1/124.31; 

//  gain  of  the  differentiator  of  finger  1  joint  1 
nil  =  3450  *  12.5/4; 
nmll  =  1; 

numll  =  convolve  (nil, nmll);  //  numerator  of  plant  with  velocity  feedback 
dimnumll  =  size  (numll); 
sznumll  =  dimnumll  (2)  -  1; 

//  order  of  numerator  of  joint  1 
dll  =  [1  245  3450]; 
dnll  =  1; 

dnell  =  convolve  (dll, dnll); 
szdnell  =  size  (dnell); 
sz2dnell  =  szdnell  (2)  -  2; 


dnnll  =  [0  *  ones  (l,sz2dnell)  numll  *  kvll  *  kfll  0]; 

denll  =  dnell  +  dnnll; 

/ /  denominator  of  open  loop  joint  transfer  function  with  feedback  controller 
[sll,nsll]  =  sform  (numll, denll); 
gcnumll  =  [kpll  kill]; 

/ /  numerator  of  feedforward  controller 
gcdenll  =  [1  Oj; 

//  denominatoroffeedforwardcontroller 
gcgpnumll  =  convolve  (gcnumll, numll); 
gcgpdenll  =  convolve  (gcdenll, denll); 

[s,ns]  =  sform  (gcgpnumll, gcgpdenll); 

[sl,nsl]  =  feedback  (s,ns);  j 

[tnumll,tdenll]  =  tform  (sl,nsl); 

/ /  numerator  and  denominator  of  closed  loop  transfer  function  with  controllei 
tnumn  =  gcgpnumll; 


// 

// 

/////////////////////////////////////////////////////////////////// 

///// P<’>  f'>iietci  s  of  super-block  T22 

///// 

////////////////////////////////////////////////////////////////// 

// 

kp22  =  8; 

//  proportional  gain  of  PID  controller 
kv22  =  2; 

// velocity  gain  of  PID  controller 
ki22  =  1; 

//  integral  gain  of  PID  controller 
kf22  =  1/122.43; 

/ /  gain  of  the  differentiator 
n22  =  9955.55; 


nm22  =  1; 

num22  =  convolve  (n22,nm22); 

//  numerator  of  transfer  function  of  joint  1  with  feedback  controller 
d22  =  [1  90  5625]; 
dn22  =  1; 


dne22  =  convolve  (d22,dn22); 
szdne22  =  size  (dne22); 
sz2dne22  =  szdne22  (2)  -  2; 

dd22  =  [0  *  ones  (I,sz2dne22)  num22  *  kv22  *  kf22  0]; 
den22  =  dne22  -f  dd22; 


//  denominator  of  transfer  function  of  joint  1  with  feedback  controller 

// 

// 

///////////////////////////////////////////////////////////////// 

/////  Parameters  of  super-block  BL0CK2 

mil 

///////////////////////////////////////////////////////////////// 

// 

// 

[s22,ns22]  =  sform  (num22,den22); 

[st22,nst22]  =  sform  (gcgpnum22,gcgpdcn22); 

[stl22,nstl22]  =  feedback  (st22,nst22); 

[tnuin22,tdeu22]  =  tform  (stl22,nstl22); 
tnum22  =  gcg|)num22; 

//  numerator  &  denominator  of  closed  loop  transfer  function  of  joint  2 
//  with  coriti'ollcr. 
pcool2num  =  [1  48  900]; 

//  numerator  of  coupling  between  outputs  of  joints  1  2 

pcool2den  =  [1  96  3600]; 

/ /  denominator  of  coupling  between  outputs  of  joints  1  &  2 
tnuml2  =  convolve  (tnumll,pcool2num); 
tdenl2  =  convolve  (tdenll,pcool2den); 

//  numerator  and  denominator  of  input-output  coupling  between  joint  1 
/ /  and  joint  2.  , 

[sl2,nsl2]  =  sform  (tnuml2,tdenl2); 
t22itl2num  =  convolve  (tden22,tmirn]2); 
t22itl2den  =  convolve  (tnum22,tdenl2); 
dimiuim22  size  (iuim22); 

sznum22  =  dimnum22  (2)  -  1;  //  order  of  numerator  of  joint  2 
[sp22,nsp22]  =  sform  (num22,den22); 
dimnuml2  =  size  (tnuml2); 
sznuml2  =  dimnuml2  (2)  -  1; 

[s12,nsl2]  =  sform  (tnuml2,tden]2); 
dimn22ir2  =  size  (t22itr2num); 
szn22il2  =  dimn22il2  (2)  -  1; 

[s22il2,ns22il2]  =  sform  (t22itl2num,t22itl2den); 

[sll,nsll]  =  sform  (numll,denll); 
dimnumll  =  size  (numll); 
sznumll  =  dimnumll  (2)  -  1; 
gcnumll  =  [kpll  kill]; 
gcdenll  =  [1  0]; 

gegp numll  =  convolve  (gcnumll, numll); 


gcgpdenll  =  convolve  (gcclenll,clenll); 

[s,ns]  =  sfonn  (gcgpnumll, gcgpdenll); 

// 

// 

// 

//////////////////////////////////////////////////////////////////////// 

/////  Parameteis  of  super-block  T33,  super-block  13LOCK3  and 
///// super-block  BL0CK4  (  finger  1  joint  3) 

///// 

//////////////////////////////////////////////////////////////////////// 

//  The  values  of  the  different  blocks  of  super-blocks  T33,  BLOCKS  and 
//  BL0CK4  are  calculated  in  this  section 
kp33  =  8; 

//  proportional  gain  of  PID  controller 
kv33  =  2; 

//  velocitj'  gain  of  PID  controller 
ki33  =1; 

//  integral  gain  of  PID  controller 
kf33  =  1/120.46; 

//  gain  of  differentiator 
nm33  =  17787.94; 
n33  =  800; 

num33  =  convolve  (n33,nm33); 

//  mimerator  of  open  loop  transfer  function  of  joint  3 
//  with  feedback  controller 
dimnumSS  =  size  (num33); 

.sznum33  =  diiniuirnSS  (2)  -  ];. 

dn33  =  [1  340  22500]; 

d33  =  [1  800];  ‘ 

dne33  =  convolve  (dn33,d33); 

szdne33  =  size  (dne33); 

sz2dne33  =  szdne33  (2)  -  2; 

dd33  =  [0  *  ones  (I,sz2dne33)  nuni33  *  kv33  *  kf33  0]; 

den33  =  dneSS  -f  <ld33; 

//denominator  of  open  loop  transfer  function  of  joint  3  with  feedback  controller 
[sp33,nsp33]  =  sform  (num33,den33);  ■ 

gc33num  =[kp33  ki33]; 

// numerator  of  feedforwcird  controller 
gc33den  =  [10]; 

/ /  denominator  of  feedforward  controller 
gcgp33num  =  convolve  (gc33num,num.33); 


gcgp33clen  =  convolve  (gc33den,den33); 

[scp33,nscp33]  =  sform  (gcgp33num,gcgp33den); 

[st33,nst33]  =  feedback  (scp33,nscp33); 

[tnum33,tden33]  =  tform  (st33,nst33); 

//  numerator  and  denominator  of  closed  loop  transfer  function  of  joint  3 
//  with  controller 
tnum33  =  gcgp33num; 
pcool3num  =  643.383; 

//  numerator  and  denominator  of  coupling  between 
pcool3den  =  [1  18  8100]; 

//  outputs  of  joint  1  &  joint  3 
tnuml3  =  convolve  (tnumll,pcool3num); 

/ /  numerator  &  denominator  of  coupling 
tdenl3  =  convolve  (tdenll,pcool3den); 

/ /  between  input  of  joint  1  and 
/ /  output  of  joint  3 
pcoo23num  =  .9576  *  [1  70  2500]; 
pcoo23den  =  [1  119  7225]; 

//  numerator  and  denominator  of  coupling  between  outputs  of  joint  1 
//  and  joint  3 

tnum23  =  convolve  (tnum22,pcoo23nuni); 
tden23  =  convolve  (tden22,pcoo23den); 

/ /  numerator  and  denominator  of  coupling  between  input  of  joint  2 

/ /  and  output  of  joint  3 

t33itl3num  =  convolve  (tden33,tnuml3); 

t33itl3den  =  convolve  (tnum33,tdenl3); 

[s33il3,ns33il3]  =  sform  (t33itl3num,t33itl3den); 
t33it23nuiT)  =  convolve  (tden33,tniim23); 
t33it23den  =  convolve  (tiunn33,tden23); 

[s33i23,ns33i23]  =  sform  (t33it23num,t33it23den); 

[stl3,nstl3]  =  sform  (tnuml3,tdenl3); 

[st23,nst23]  =  sform  (tnum23,tden23); 
dimnuml3  =  size  (tnuml3); 
sznuml3  =  diranuml3  (2)  -  1; 
dimnum23  =  size  (tnum23); 
sznum23  =  dimnum23  (2)  -  1; 
dimn3.3il3  =  size  (t33itl3num); 
szn33il3  =  dimn33il3  (2)  -  1; 
dimn33i23  =  size  (t33it23num); 
szn33i23  =  dimn33i23  (2)  -  1; 

// 

// 

///////////////////////////////////////////////////////// 


///// 

/////  Editing  super-block  BLOCKl 

///// 

//////////////////////////////////////////////////////// 

// 

// 

Edit;  blockl;  0; 

Modify;  12; 

New  Block  Parameters;  kpll; 

Done  Update  Block; 

Modify;  2; 

New  Block  Parameters;  1;  kill; 

Done  Update  Block; 

Modify;  14; 

New  Block  Parameters;  sznumll;  numll;  szdenll;  den  11; 

Done  Update  Block;  top;  mat; 

// 

// 

//////////////////////////////////////////////////////// 

///// 

/////  Editing  super-block  T22 

///// 

/////////////////////////////////////////////////////// 

// 

// 

Build; 

Edit;  t22;  0; 

Modify;  12; 

New  Block  Parameters;  kp22; 

Done  Update  Block; 

Modify;  2; 

New  Block  Parameters;  1;  ki22; 

Done  Update  Block; 

Modify;  14; 

New  Block  Parameters;  sznum22;  num22;  szden22;  den22; 

Done  Update  Block; 
top 

// 

// 

/////////////////////////////////////////////////////// 

///// 

///// Editing  super-block  BLOCK2 

///// 


/////////////////////////////////////////////////////// 

// 

Edit;  block2;  0 
Modify;  1 ; 

New  Block  Parameters;  szn22il2;  t22itl2num;  t22itl2den; 
Done  Update  Block; 

Modify;  2; 

New  Block  Parameters;  sznuml2;  tniiml2;  szdenl2;  tdenl2;  6; 

// 

// 

////////////////////////////////////////////////////// 

///// 

/////  Editing  super-block  T33 

///// 

////////////////////////////////////////////////////// 

// 

// 

build; 

Edit;  t33;  0; 

Modify;  12; 

New  Block  Parameters;  kp33; 

Done  Update  Block; 

Modify;  2; 

New  Block  Parameters;  1;  ki33; 

Done  Update  Block; 

Modify;  14; 

New  Block  Parameters;  sznum33;  num33;  dcn33; 

Done  Update  Block; 
top; 

// 

// 

///////////////////////////////////////////////////// 

///// 

/////  Editing  super-block  BLOCK4 

///// 

///////////////////////////////////////////////////// 

// 

// 

Edit;  block4;  0; 

Modify;  1; 

New  Block  Parameters;  sznuml3;  tnuml3;  tdenl3; 

Done  Update  Block; 


Modify;  11; 

New  Block  Parameters;  sznum23;  tnum23;  tden23; 

Done  Update  Block; 

// 

/•/ 

//////////////////////////////////////////////////// 

///// 

///// Editing  super-block  BL0CK3 

///// 

//////////////////////////////////////////////////// 

// 

// 

Edit;  blocks;  0; 

Modify;  4; 

New  Block  Parameters;  szn33il3;  t33itl3num;  t33itl3den; 
Done  Update  Block; 

Modify;  1; 

New  Block  Parameters;  szn33i23;  t33it23num;  t33it23den; 

Done  Update  Block; 
top; 

// 

// 

save  ‘varspblocks’; 

//  This  command  saves  all  the  variables  created  in  a  file  called 
//  varspblocks. 


Figure  G2  Position  control  loop  of  finger  1  joint  2 


Figure  G4  Coupling  between  finger  1  joints  1  and  2 


Figure  G5  Coupling  between  finger  1  joint  3  and  joints  1  and  2 


Continuous  Bupor-Bteck  Ext.  In 
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